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Abstract 


The  problem  of  parameter  estimation  using  tracking 
information  is  examined.  Two  models  are  developed  and  used 
to  estimate  the  misalignment  angles  of  the  inertial  system 
of  a missile  after  its  lavinch.  The  estimation  is  based  on 
maximum  likelihood  concepts.  The  amount  of  Information 
extracted  from  the  tracking  measurements  and  the  missile 
specific  forces  measurements  is  analysed. 

A feasibility  study  of  the  two  models  is  conducted. 

The  second  model  uses  the  aerodynamic  model  of  the  missile 
in  order  to  enhance  its  estimation  ability.  Doing  this,  it 
Incorporates  more  non-linearities  than  the  first  model. 
These  severe  non-linearities  were  found  to  offset  the 
advantage  it  had  in  terms  of  information  gathering.  The 
first  model  is  much  simpler  in  its  concept.  Yet,  it  is 
still  able  to  gather  the  information  needed  and  its  per- 
formance is  very  comparable  to  the  one  of  the  second  model. 
The  simplicity  and  linearity  of  the  first  model  make  it 
especially  attractive. 
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APPLICATION  OF  A MAXIllUM  LIKELIHOOD  PARAMETER 
ESTIMATOR  TO  AN  ADVANCED  MISSILE 
GUIDANCE  AND  CONTROL  SYSTEM 

I.  Introduction 
Background  and  Motivation 

An  ever  Increasing  amount  of  research  Is  being  directed 
toward  the  development  of  standoff  weapons.  Unfortunately, 
the  probability  of  hitting  the  target  decreases  as  the 
range  from  the  target  Increases  or  in  other  words,  safety 
comes  at  the  price  of  a lack  of  accuracy.  In  order  to  keep 
a high  probability  of  hitting  the  target  even  though  the 
release  range  Is  safe  enough,  an  accurate  navigation  system 
has  to  be  added  to  the  missile.  The  navigation  system  will 
then  guide  the  missile  through  the  mid-course  part  of  the 
flight  until  close  vicinity  to  the  target  is  reached.  Then 
the  homing  system  of  the  missile,  responsible  for  the 
terminal  guidance,  will  guide  it  to  the  target  accurately. 

One  of  the  disadvantages  of  the  various  homing  systems 
used  is  that  their  operation  is  limited  to  a small  area 
arotmd  the  target.  The  navigation  system  used  for  the  mid- 
course guidance  has  then  to  be  very  accurate.  Because  of 
economical  considerations,  the  missile  being  expendable, 
only  medium  to  low  quality  inertial  navigation  systems  are 
usually  mounted  on  missiles. 

Among  numerous  other  contributors  to  the  existence  of 
erroneous  inertial  navigation  of  the  missile  (such  as  gravity 


anomalies,  aircraft  Initial  position  and  attitude  uncertain- 
ties), two  of  the  major  error  sources  can  be  the  transfer 
alignment  errors  (Initial  aircraft  to  missile  alignment  of 
the  Inertial  reference  frames),  and  error  parameters  of  the 
missile's  Inertial  Instruments  (such  as  scale  factors  or 
biases  of  the  gyros  and  accelerometers) . Only  the  former 
Is  considered  In  this  study. 

Surprisingly  enough,  prelaunch  calibration  and  align- 
ment procedure  of  the  platform  of  the  missile  has  a limited 
accuracy,  expressly  due  to  the  relatively  benign  aircraft 
environment  (basically  a perturbed  1 g flight  path) . Indeed, 
one  would  expect  this  environment  to  be  Ideal  for  the  align- 
ment of  an  Inertial  platform.  Nevertheless,  this  environ- 
ment causes  unldentlf lability  of  error  sources , therefore 
causing  the  misalignment  angles  to  be  less  observable  and 
slowing  down  the  estimation  convergence  (Ref  1) . With  the 
Incorporation  of  sophisticated  avionics  for  aircraft  naviga- 
tional update  and  fire  control  (for  example,  the  Electroni- 
cally Agile  Radar  - EAR,  developed  through  the  Air  Force 
Avionics  Laboratory)  , tfiere  exists  a new  possibility  for 
further  reduction  of  error  magnitudes  from  the  various 
sources . 

It  Is  presumed  that  the  aircraft  can  track  the  missile 
with  Its  radar  and  communicate  with  It  through  a two-way 
data- link.  This  communication  link  can  be  used  to  command 
accelerations  to  the  missile  and  to  receive  back  the  achieved 
specific  forces  as  measured  by  the  missile's  accelerometers 


f I 

F • 

I 

in  a stabilized,  non-rotating  missile  inertial  frame.  The 
missile  shall  undergo  much  higher  accelerations  during  launch 
and  through  maneuvering  commands  as  compared  to  its  prelaunch 
accelerations.  Hence,  the  identif lability  of  error  para- 
meters is  potentially  much  greater  than  it  might  be  during 
the  prelaunch  benign  phase. 

Since  the  acceleration  commands  are  generated  with 
respect  to  the  aircraft  inertial  frame,  but  received,  inter- 
preted, and  Implemented  with  respect  to  the  missile  Inertial 
reference  frame,  it  is  potentially  possible  to  "close  the 
loop"  around  the  aircraft  to  missile  alignment  by  tracking 
the  missile  trajectory  with  respect  to  the  aircraft  inertial 
frame. 

This  report  concerns  itself  with  the  ability  to  estimate 
the  misalignment  angles  caused  to  the  missile's  inertial 
platform  during  the  launching  period.  The  assumption  is 
made  that  after  these  angles  are  estimated,  they  would  be 
transmitted  to  the  missile  to  be  incorporated  within  the 
missile  navigational  computer.  The  missile  would  then  be 
guided  to  its  Intended  target  more  accurately. 

A possible  scenario  illustrating  the  application  of 
the  concept  described  above  Involves  an  area  surveillance, 
command,  and  control  aircraft  flying  at  safe  height  and 
range  from  the  target.  Various  strike  aircrafts  would 
launch  their  missiles  and  return  quickly  to  their  bases. 

The  missiles  will  first  boost  until  they  arrive  to  the  area 
controlled  by  the  command  and  control  aircraft.  Then  they 
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will  coast  toward  their  targets  with  erroneous  attitude 
and  heading  due  to  the  Initial  misalignment.  During  the 
first  few  seconds  of  this  coasting  flight,  the  control  air- 
craft will  track  the  missiles,  estimate  their  misalignment 
angles  and  transmit  them  to  the  missiles  In  order  to  realign 
their  platforms.  The  missiles  will  then  be  well  equipped 
for  an  accurate  navigation  toward  their  targets. 

Several  works  have  been  accomplished  in  the  general 
tracking  area  (Refs  2,  3).  In  most  cases.  In  order  to 
simplify  the  filter  implementation,  the  tracking  algorithms 
have  been  implemented  in  the  line-of-sight  frame.  However, 
this  does  not  appear  to  be  an  appropriate  choice  of  frames 
in  this  case  which  involved  two  inertial  platforms,  one 
on  the  control  aircraft  and  one  on  the  missile.  Two  inertial 
frames  are  thereby  defined  and  it  would  be  computationally 
ciimbersome  to  relate  them  by  an  additional  llne-of-slght 
frame.  Therefore,  it  is  desirable  that  the  tracking  filter 
provides  an  estimate  of  the  misalignment  angles  In  a local 
Inertial/ stationary  frame  --  the  aircraft  inertial  frame. 

This  is  especially  true  for  the  case  in  which  the  aircraft 
is  tracking  more  than  one  missile. 

Statement  of  the  Problem 

Control  surface  deflection  commands  which  are  the 
source  of  commanded  accelerations;  are  generated  in  the  air- 
craft. There  are  two  possibilities  for  closing  the  loop 
aroimd  the  aircraft-missile  misalignment.  The  first  way  is 
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to  Ignore  the  fact  that  the  acceleration  connnands  are  gener- 
ated in  the  aircraft  frame.  Then  the  trajectory  observed 
by  the  aircraft  radar  is  compared  to  the  one  generated  by 
a double  integration  of  the  missile  specific  force  measure- 
ments (in  the  missile  inertial  frame) . This  discards  some 
of  the  information  inherently  available,  but  it  allows  a 
particularly  simple  mechanization. 

The  second  method  uses  the  fact  that  the  acceleration 
commands  are  generated  in  the  aircraft  frame  but  implemented 
in  the  missile  frame  to  provide  additional  information  about 
the  misalignment.  Since  the  missile's  characteristics  are 
known  to  the  controlling  aircraft,  it  is  possible  to  predict 
the  accelerations  which  should  be  achieved  in  response  to  the 
commands.  Ignoring  missile  plant  dynamics  uncertainties, 
the  difference  between  the  commanded  and  achieved  accelera- 
tions is  directly  related  to  the  misalignment  angles.  This 
additional  information  should,  conceptually,  improve  the 
estimation  accuracy. 

All  techniques  used  to  determine  the  angular  alignment 
of  coordinate  frames  depend  on  the  measurement  of  the 
orientation  of  the  coordinate  frames  with  respect  to  two 
or  more  vectors  that  are  common  to  each  coordinate  frames  -- 
physical  vectors  (Ref  4:685).  In  method  1,  the  common  vec- 
tor is  the  change  in  the  relative  position  of  the  missile 
while  in  method  2 it  is  the  missile  measured  specific 
force  vector.  Figures  1 and  2 will  illustrate  the  basic 
differences  between  the  two  methods  --  the  position 
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prediction  method  and  the  acceleration  prediction  method. 

The  figures  represent  the  simple  case  in  which  noise  does  not 
perturb  the  measurements. 

In  Figure  1,  the  three  components  of  the  specific 
force  vector  (SF)  measured  by  the  missile's  accelerometers 
are  transmitted  to  the  aircraft.  In  the  first  method,  those 
components  are  integrated  as  they  are  received.  To  calculate 
the  position  increment  (AP(SF) ) expected  on  the  basis  of  the 
specific  force  received.  This  position  increment  is  then 
compared  to  the  one  measured  by  the  radar  (AP (Radar))  and 
the  difference  between  them  is  used  to  estimate  the  mis- 
alignment angles  (e)  . 

Figure  2 illustrates  the  concept  of  the  second  method. 
The  aircraft  computer  "knows"  the  characteristics  of  the 
missile  (its  aerodynamical  model,  and  parameters);  therefore, 
upon  sending  a control  surface  deflection  command  to  the 
missile,  it  can  generate  an  expected  specific  force  (^)  . 

The  measured  value  of  the  achieved  specific  force  (SF)  will 
be  different  than  the  expected  specific  force  as  a function 
of  the  misalignment  angles  (£) . 

The  expectation  of  the  specific  force  (^)  is  based  on 
the  assumption  that  the  lift  operating  on  the  missile  is 
perpendicular  to  the  velocity  vector  (as  stated  in  the 
assiimptlon  to  Chapter  II,  section  3).  Therefore,  the 
velocity  vector  built  through  the  radar  measurements,  serves 
to  Indicate  a plane  to  which  the  expected  specific  force  is 
perpendicular . 
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AIRCRAFT  MISSILE 

COORDINATES  COORDINATES 

Fig.  2 Acceleration  Prediction  Method 

It  is  seen  clearly  that  Method  2 in  fact  uses  all  the 
information  of  Method  1 and  adds  to  it  the  "information 
content”  of  the  difference  between  the  actual  versus  the 
expected  response  of  the  missile.  The  usefulness  of  this 
second  source  of  information  is  highly  dependent  on  the 
ability  of  the  designer  to  model  the  acceleration  character- 
istics of  the  missile  accurately.  No  attempt  is  made  in 
this  study  to  determine  these  sensitivities.  Rather,  this 
study  deals  with  the  determination  of  the  relative  level 
of  information  potentially  available  under  the  best  circtim- 
stances  (i.e.  perfect  missile  dynamics  model). 
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Hence,  the  prime  objective  of  this  study  is  to  evaluate 
the  "information  content"  of  the  two  methods  in  order  to 
determine  the  potential  estimation  enhancement  due  to  the 
additional  information  of  the  second  method.  The  second- 
ary objective  is  to  apply  the  two  methods  to  estimate  the 
misalignment  angles  in  a typical  launch  scenario  and  to 
compare  the  quality  of  the  results.  The  second  method  is 
considerably  more  complicated  than  the  first,  and  so  the 
research  investigation  shall  provide  insight  into  whether 
or  not  the  additional  complexity  of  the  second  method  has 
substantial  estimation  accuracy  potential  worth  pursuing.  ; 

The  development  of  a "truth  model"  for  the  engagement 
scenario  is  another  component  of  the  problem.  The  truth 
model  is  a description  of  missile  parameters  and  dynamics 
and  system  (missile/aircraft)  kinematics  and  uncertainties. 

It  is  the  "best  model"  of  the  real  world  in  that  it  includes 
as  many  effects  as  possible,  regardless  of  the  resulting 
system  complexity.  The  truth  model  is  exercised  in  a com- 
puter simulation  to  provide  nominal  trajectories  for  analysis 
of  the  two  models.  A more  complex  model  can  be  considered 
as  a truth  model.  However,  due  to  the  limited  scope  of  this 
research,  the  simpler  generic  model  developed  by  TASC  (Ref  5) 
and  modified  in  this  study  was  preferred  as  representative 
of  a broader  range  of  missiles  to  illustrate  the  techniques. 

The  nominal  trajectory  is  a deterministic  (reference) 
trajectory  that  starts  from  a known  set  of  initial  conditions, 

^(tQ),  and  propagates  according  to  the  differential  equation: 
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Xn(t)  = u(t).  t] 


(1) 


1 


where 

f [ 1^0-  known  function  of  the  arguments 

^(t)  * the  nominal  trajectory 

u(t)  = deterministic  forcing  function 

t * time 

Associated  with  the  nominal  trajectory  is  a sequence  of 

nominal  sampled  data  measurements  --  radar  and  specific 
force  measurements.  Both  models  use  those  measurements 
corrupted  by  an  additive  white  noise  as  output  measurements. 

Both  models  are  also  exercised  against  three  different 
control  patterns  for  the  trajectory  of  the  missile.  This 
allows  a partial  investigation  of  the  difference  in  the 
various  sensitivities  of  the  output  measurements  with 
respect  to  the  different  types  of  commands  to  the  missile. 

It  is  indeed  known  from  the  theory  of  input  design  (Ref  6) 
that  the  control  inputs  to  the  missile  can  be  optimized 
to  provide  maximum  information  content  --  thereby  maximizing 
the  estimation  capability.  However,  a full  analysis  of 
this  problem  is  beyond  the  scope  of  this  study. 

As  mentioned,  the  prime  intent  of  this  study  is  to 
compare  the  information  content  of  the  two  methods . There- 
fore, a basic  maximum  likelihood  estimator  is  used  and  the 
comparison  of  the  methods  is  made  on  the  basis  of  their 
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information  matrices.  The  feasibility  of  a full-scale  max- 
imum likelihood  estimator  is  thereby  demonstrated  though  no 
attempt  is  made  to  investigate  the  means  to  achieve  on  line 
applicability. 

The  information  matrix  (M)  is  then  formed  as: 


N 32.  ^ -1  3y 

» E ( 3^  ) (n)  . R(n)  * ( ^ ) (n) 
n=l 


where  ( -^  ) (n)  are  the  output  (y)  sensitivities  to  the  un- 
known  misalignment  angles  (e)  at  discrete  time  (n)  — as- 
suming £ is  constant,  and  R(n)  is  the  inverse  of  the  co- 
variance  of  the  measurement  noise  (Ref  6) . The  information 
matrix  conceptually  describes  how  much  information  about 
the  state  of  the  system  is  contained  in  the  data  (Ref  7: 
231).  N is  the  niimber  of  sampled  measurements  which  are 
taken  during  the  tracking  period. 

Major  Techniques 

A simulation  of  the  "truth  model"  and  of  the  two 
estimation  processes  is  performed  on  a CDC  6600  computer. 
Euler  integration  was  used  with  a step  size  of  .01  sec  on 
the  50  sec  tracking  interval.  This  was  dictated  by  the  time 
constants  of  the  system  and  though  the  integration  steps 
could  be  much  longer  when  integrating  the  sensitivities, 
the  information  matrix,  and  the  gradient  vector  elements. 
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they  were  all  chosen  equal  for  the  sake  of  simplicity.  The 
sampling  period  was  also  chosen  to  be  .01  sec  for  the  same 
reason . 


A system  of  "state-sensltlvltles"  Is  built  consisting 
of  the  sensitivities  of  the  six  states  representing  position 
and  velocity  (the  only  states  considered  in  this  study) 
with  respect  to  the  three  misalignment  angles.  The  output 
vector  (or  measurement  vector)  sensitivities  are  then  defined 
as  functions  of  the  state  sensitivities. 

The  information  matrix  and  the  gradient  vector  are 
developed  using  Information  theory  and  taking  Into  considera- 
tion the  uncertainty  involved  with  the  measurement.  These 
are  then  used  to  calculate  the  optimal  correction  to  the 
misalignment  angles. 

Organization 

This  thesis  consists  of  four  chapters.  Chapter  I out- 
lines the  motivation  and  background  for  Investigating  the 
feasibility  of  maximum  likelihood  estimation  to  a problem 
of  estimating  parameters  Involved  In  a nonlinear  use. 

Chapter  II  develops  the  system  truth  model  and  presents 
the  assumptions  made  In  the  engagement  scenario.  Chapter 
III  Introduces  the  Maximum  Likelihood  Filter  Equations  and 
presents  the  formulation  of  the  two  specific  models  Investi- 
gated. The  Output  Error  Functional  and  the  performance 
criterion  are  also  discussed  In  this  chapter.  Chapter  IV 
Includes  the  discussion  about  the  numerical  results.  Having 
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demonstrated  concept  feasibility,  several  suggestions  are  | 

] 

presented  for  future  optional  studies.  The  appendices 
contain  some  theory  about  Maxim;jm  Likelihood  Estimation, 
the  detailed  derivation  of  some  of  the  equations,  the 
description  and  computer  listing  of  each  of  the  computer 

I 

programs  developed  for. this  study,  and  the  nimierical  re- 
sults. 
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II.  System  Truth  Model 


Introduction 

This  chapter  develops  the  realistic  models  of  the 
aircraft,  missile,  and  engagement  geometry.  The  system 
models  should  represent  the  dominant  dynamics  and  non- 
llnearlties  of  the  engagement  scenario,  and  yet  be  repre- 
sentative of  a wide  spectr\im  of  missiles.  The  model  Is 
divided  into  several  components,  as  shown  in  Figure  3. 

It  is  important  to  note  that  the  primary  objective  of  this 
report  is  to  describe  and  analyze  the  ability  to  estimate 
parameters  in  the  navigation  and  guidance  equations  for  the 
missile  (the  three  misalignment  angles  of  the  inertial 
platform  of  the  missile)  . The  missile  siibsys terns  and 
dynamics  are,  therefore,  modelled  in  much  greater  details 
than  other  truth  model  components  (for  example,  the  air- 
craft) and  yet  kept  as  simple  as  possible  so  that  they  do 
not  shadow  the  main  thrust  of  this  study  --  the  estimation 
problem.  Prior  to  discussing  the  individual  components, 
however,  the  assumptions  that  have  been  made  in  the  develop- 
ment of  the  model  are  presented. 

Assumptions . The  control  aircraft  which  is  tracking 
the  missile  is  modelled  as  a point  mass.  In  addition,  the 
inertial  navigation  system  of  the  aircraft,  with  respect  to 
which  the  missile's  inertial  system  is  evaluated,  is  ass\imed 
to  be  perfectly  aligned  and  stable  so  that  it  can  be  .regarded 
as  forming  a stationary  frame  in  which  the  missile  is 
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observed.  It  Is  further  assumed  that,  relative  to  each 
other,  the  aircraft  and  the  missile  Inertial  frames  are 
non-rotating  and  non-drlftlng.  The  assumption  of  non-rota- 
tion Is  really  made  without  any  loss  of  generality  since 
rotating  frames  (as  In  the  case  of  the  wander  azimuth 
Inertial  platforms)  consist  of  a controlled  rotation  that, 
since  known,  can  always  be  taken  Into  accoimt.  Likewise, 
the  assumption  of  no  drift  has  little  effect  upon  the  Infor- 
mation analysis  (parameter  sensitivity  analysis)  which  Is 
conducted  In  this  study.  However,  the  drift  would  have  to 
be  taken  Into  account  In  an  actual  on-line  estimator  In 
which  the  misalignment  angles  would  be  modelled  as  slowly 
varying  parameters,  and  a maximum  likelihood  estimator, 
for  example,  would  be  employed  (Ref  8:10-9). 

Navigation  systems  that  are  currently  available  In 
aircraft  have  errors  that  are  second  or  higher  order 
effects  when  compared  to  errors  In  the  measurements  of  the 
missile  dynamics  with  the  radar  tracker.  Therefore,  the 
assumption  of  a perfect  Inertial  navigation  system  on  the 
aircraft  does  not  affect  the  model  Integrity,  while  It 
greatly  simplifies  It.  It  Is  further  assumed  that  meteoro- 
logical effects  can  be  Ignored.  This  assumption  appears 
reasonable  since  the  time  period  of  the  tracking  of  the 
mlsrlle  Is  short,  both  the  missile  and  aircraft  are  In  the 
same  air  mass,  and  finally  because  the  magnitudes  of 
meteorological  effects  will  In  general  be  of  second  order 
In  comparison  to  the  missile  dynamics.  Other  assumptions 
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that  are  peculiar  to  a particular  model  component  will  be 
discussed  In  the  applicable  section. 

Coordinate  Frames 

Aircraft  Local  Vertical  Inertial  Frame  (X^,  Y^,  Z^) . 
Located  at  the  aircraft  center  of  gravity.  The  axis  Is 
In  the  "true"  north  direction,  the  axis  Is  In  the  "true" 
east  direction,  and  the  axis  Is  In  the  "true"  down 
direction. 

Missile  Local  Vertical  Inertial  Frame  (Xj^,  Yj^,  Zj^)  . 
Located  at  the  missile's  center  of  gravity.  The  X^  axis 
Is  In  the  missile  Indicated  "north"  direction,  the  Yj^  axis 
Is  In  the  missile  Indicated  "east"  direction,  and  the  Zj^ 
axis  Is  In  the  missile  Indicated  "down"  direction. 

These  definitions  of  frames  assxame  the  range  between 
the  aircraft  and  the  missile  to  be  such  that  the  difference 
between  the  "true  Inertial"  direction  (north-east-down)  at 
the  location  of  the  aircraft  and  missile.  Is  negligible. 

Misalignment  Euler  Angle  Rotation.  Euler  angles  are 
used  to  define  the  misalignment  between  the  missile's  and 
the  alrcraftfs  Inertial  frame.  The  misalignment  angles  are 
assumed  to  be  small,  so  they  may  be  treated  as  components 
of  a vector  e . 
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intermediate  unit  vectors  for  the 
transformation  that  represents  the  Euler  angle  rotations 
in  sequence  (Ref  9:37): 
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The  transformation  is  defined  as  the  product  of  the 
three  matrices  in  Equations  (4) : 
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CosOCosij)  CosSSlntj;  -Sln9 

■ -Cos4)Slni)rf-Sln<t)Sln6Cosi);  Cos(|>Cosi|;+Sln(j)Sin6Slni|)  Sln(|)Cos6  (5) 
Sln(^Slni|H-Cos(t)Sin6Cos4i  -Sln(|>Cosijj+Cos(t>Sln6Slni|^  Co8<t)Cos6 

Assuming  small  misalignment  angles  (represented  by  the 
general  angles  a and  3) : 

Slna  = a;  SinaSinS  = 0;  Cosa  = 1 

and  so : 


M 

Since  is  an  orthogonal  transformation,  the  inverse  is 
eqxial  to  its  transpose  (neglecting  second  order  terms)  and; 


Missile  Guidance 

Airframe  Dynamics . The  rotational  motion  of  an  airframe 
is  generally  described  in  terms  of  six  state  variables  -- 
three  angles  and  three  angular  rates.  The  exact  differential 
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equations  of  motion  for  these  variables  are  nonlinear  and 
are  also  coupled  to  the  translational  motion  of  the  airframe 
through  such  quantities  as  airspeed  and  altitude,  which 
describe  the  missile's  flight  condition.  The  coupling 
between  translation  and  rotation  Is  simplified  If  the 
former,  being  affected  primarily  by  the  relatively  long 
response  time  of  the  guidance  loop.  Is  regarded  as  being 
Independent  of  the  autopilot  characteristics.  Consequently, 
In  the  rotational  equations  of  motion,  altitude  and  airspeed 
can  be  regarded  as  time-varying  parameters  that  are  Inde- 
pendent of  the  missile  airframe  response  characteristics. 

In  the  case  covered  in  this  study,  the  missile  Is  supposed 
to  cruise  for  quite  a long  range.  This  would  require  wider 
wings  for  a better  lift  coefficient  but  would  deny  the 
designer  the  ability  to  assume  Instantaneous  roll  stability. 
The  roll  dynamics  are  therefore  taken  as  a first  order  lag 
system  with  a shorter  time  constant  than  the  one  for  the 
pitch  dynamics  (bank-to-tum  missile) . After  these  simpli- 
fications there  still  remain  nonllnearltles  in  the  depen- 
dence of  the  equations  of  motion  upon  angle  of  attack  and 
control  surface  deflection  angle;  these  can  be  eliminated 
with  small  angle  approximations.  The  mathematical  model 
tised  here  to  describe  pitch  motion  Is  for  a missile  which 
develops  lateral  maneuvering  forces  through  aerodynamic 
lift  provided  by  fixed  wings  or  by  the  missile  body,  with 
the  aid  of  tall-mounted  control  surfaces.  The  model  neglects 
longitudinal -lateral  coupling  and  assinnes  a second  order 


airframe  and  a first  order  actuator  dynamics  with  equations 
of  motion  given  by  (Ref  5:2-2  to  2-5): 


4(t)  - Mq-q(t)  + Mjj-a(t)  + M5-6(t)  (8) 

i(t)  - q(t)  - Lci-o(t)  - Lfi.6(t)  (9) 

6(t)  = -X-6(t)  + X-6c(t)  (10) 

6(t)  “ -V  •B(t)  + vBc(t)  (11) 

L(t)  - -V(t)  (i(t)  - q(t))  (12) 


where  M^,  Mg,  L^j,  and  Lg  are  stability  derivatives  and: 
a(t)  - angle  of  attack, 
q(t)  - pitch  rate, 

L(t)  - normal  acceleration  (lift) , 

V(t)  - air  speed, 

6(t)  - control  surface  deflection, 

6jXt)  - control  surface  deflection  command, 

0(t)  - bank  angle, 

6g(t)  - bank  angle  command, 

1/X  - pitch  actuator  time  constant, 

1/v  - bank  servo  time  constant. 
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The  stabilized  roll  angle  of  the  missile  is  measured  by  its 
inertial  system  and  defined  with  respect  to  it.  Once  the 
roll  angle  (in  the  missile's  inertial  frame)  is  known, 
deflection  commands  can  be  resolved  to  the  pitch  or  yaw 
control  surfaces.  This  study  does  not  deal  with  the 
resolution  of  the  commanded  deflection  between  the  two 
pairs  of  fins.  6(t)  is  then  the  effective  control  surface 
deflection  (Fig.  4). 

Kinematics . The  total  velocity  of  the  missile  (the 
superscript  denotes  the  frame  in  which  the  vector  is  expressed, 
M - for  the  missile's  inertial  frame,  and  A - for  the  aircraft 
inertial  frame)  is  at  an  azimuth  angle  and  an  elevation 
angle  Y£  with  respect  to  the  missile's  inertial  frame.  The 
banking  angle  6 is  measured  around  the  positive  direction. 


22  I 


L 


a 


J 


Fig.  5 The  Missile  Inertial  Frame 

from  the  horizontal  plane  (Fig.  5).  Xy,  Yy,  Zy  define  a 
coordinate  frame  such  that  Xy  is  in  the  direction,  Yy  is 
in  the  direction  defined  by  the  right  wing  of  the  missile 
on  the  horizontal  plane  (at  zero  bank  angle)  and  Zy  is 
determined  by  the  cross  product  (Xy  x Yy)  . X^,  Yj^, 

(i  ■ 1,  2)  are  intermediate  xinit  vectors  for  the  transfor- 
mation: 
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As  seen  in  Fig.  3,  and  r£  can  resolve  the  total  missile 
velocity  (V)  into  its  components  in  the  missile  inertial 
frame  — V^,  V2,  V3  (Fig.  5): 
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The  transformation  from  the  aircraft  coordinates  to  the 
missile  coordinates  can  be  carried  out  through  the  use  of 
the  misalignment  transformation  matrix: 
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This  representation  of  the  three  components  of  the  missile 
velocity  are  used  In  the  definition  of  the  trigonometric 
functions  of  and  Vg  defined  In  Equations  (15) -(18). 

Assumptions.  The  translational  equations  of  motion 
are  driven  by  the  sum  of  external  forces  applied  to  the  air- 
frame. The  forces  modelled  In  this  study  are  the  aerodynamic 
force  and  gravity.  The  aerodynamic  force  acting  on  the  body 
of  the  missile  Is  a lift  force  acting  perpendicular  to  the 
velocity  vector  (Ref  10:328).  Gravity  Is  acting  on  the 
missile  In  the  "true"  down  direction  — the  aircraft's 
direction. 

This  study  assumes  that  the  missile's  thrust  is  equal 
and  opposite  to  Its  drag  during  the  tracking  phase.  Those 
a^ iumptlons  are  indeed  valid  especially  for  the  type  of 
missiles  dealt  with  in  this  study  --  missiles  having  a very 
smooth  aerodynamical  shape  and  designed  to  coast  for  long 
ranges. 

Another  assvimptlon  regards  the  mass  of  the  missile  and 
its  stability  parameters.  A great  part  of  the  mass  of  a 
missile  Is  fuel  and  as  It  Is  burned  to  develop  thrust,  the 
mass  of  the  missile  decreases.  With  the  change  of  mass,  a 
change  of  the  moment  of  inertia  and  of  the  location  of  the 
center  of  gravity  will  also  occur.  For  the  same  reason 
mentioned  above,  having  a missile  tracked  during  its  coast- 
ing phase,  those  factors  will  be  assumed  constant.  As  for 
the  stability  parameters,  they  are  usually  a function  of  the 
speed  of  the  missile.  Its  mass.  Its  altitude,  and  the  dynamic 
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pressure  in  the  air  mass  around  It  (Ref  5:D-2).  This  study 
will  assume  those  parameters  to  be  constant.  Their  values 
will  aiat^h  the  following  flight  conditions: 


Altitud  - 35000  ft 
Velocity  - 1500-3000  ft/ sec 
Dynamic  pressure  - 3146  Ib/ft^ 

Mass  - 28  slugs 

Centerline  moment  of  inertia  - 497  slug-ft^ 

The  parameters  values  used  for  this  study  for  the  flight 
conditions  mentioned  above  are: 

M_  - -.462  1/sec 
4 

Ma  - -5.81  l/sec2 
- -72.  1/sec^ 

La  - .379 
Lg  - .0699 

Missile  Measurements 

Radar  Measurements . The  line  of  sight  between  the  air- 
craft and  the  missile  is  defined  by  the  azimuth  angle  I 

] 

(with  respect  to  the  aircraft  inertial  frame)  and  the  h 

elevation  angle  0p  (with  respect  to  the  same  frame)  (Fig.  6). 

The  relative  position  and  velocity  of  the  missile,  as 
measured  by  the  radar  (in  the  aircraft  frame) , as  seen  in 

j' 

Fig.  6 are  therefore  given  by  the  following  equations:  i 
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Fig.  6 Radar  Geometry 


R = (x2  + y2  + z2)% 


2XX  + 2YY  + 2ZZ 
2R 


+ Za 

I?  ^ Tr 


VvX  + VvY  + V-Z 
^R 


Sin 


(X2  + y2)  % 


Sin  - Z 


where  X,  Y.  Z.  Vx.  Vy.  and  V2  are  all  relative  to  the  air- 
craft position  and  velocity.  It  is  noted  that  the  radar 
measurements  are  non-linear  functions  of  the  relative 
position  and  velocity  of  the  aircraft. 

Acceleration  Measurements . The  three  accelerometers 
mounted  on  the  inertial  platform  of  the  missile  are  meas- 
uring the  three  components  of  the  specific  force  acting 
on  the  missile  along  their  sensitive  directions.  These 
directions  are  misaligned  with  respect  to  the  true  cardinal 
directions  (represented  by  the  aircraft  inertial  framdl  by 
the  misalignment  angles.  The  accelerometers  are  instruments 
used  to  measure  specific  forces.  The  acceleration  with 
respect  to  the  inertial  space  is  therefore  the  sum  of  the 
specific  force  and  of  gravity  (Ref  11:62).  As  stated  in 
the  assumption  of  the  previous  section,  the  only  external 
force  (except  gravity)  acting  on  the  missile  is  the  lift, 
and  it  is  perpendicular  to  the  velocity  vector.  The  velocity 
being  in  the  direction  (Equation  (14)),  the  lift  is  act- 
ing in  the  -Z^  direction.  The  lift  vector  in  the  velocity 
frame  can  therefore  be  described  as: 


Using  the  transformations  defined  in  Equation  (13)  coor- 
dinatizes  the  lift  vector  in  the  missile  Inertial  frame: 


SF 


0 

0 


(25) 


The  three  components  of  the  vector  SF  are  the  three  specific 
forces  sensed  by  the  missile  accelerometers. 

Measurement  Noises 

Introduction.  This  section  models  the  random  noise 
component  of  the  system  truth  model.  This  study  considers 
only  measurement  noises  and  neglect  any  system  noises  which 
might  be  present  in  reality.  All  measurement  noises  which 
might  be  present  are  represented  by  additive  white  noise 
over  the  bandwidth  of  the  systems  considered  (Ref  12;A-10, 
A-14) . Since  this  is  a "deterministic"  information  analysis 
(using  apriori  sensitivities) , the  accuracy  of  the  "truth" 
model,  in  terms  of  the  individual  measurement  error  sources 
is  not  of  much  concern  so  that  the  lumping  of  the  error 
sources  is  a justifiable  simplification  for  this  study. 

Considering  first  the  radar  measurements,  they  will 
generally  be  corrupted  by  various  types  of  noises  which 
can  be  categorized  according  to  the  dependency  of  their 
RMS  levels  on  the  range  to  the  missile.  The  actual  noise 
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levels  and  bandwldths  are  dependent  on  the  exact  form  of 
the  measurement  signal  processor,  missile  attitude  and 
characteristics,  environmental  conditions  and  a multitude 
of  related  system  effects.  However,  using  measurements 
obtained  from  actual  hardware  or  mathematical  models,  most 
of  the  observed  measurement  noise  can  be  lumped  into  one  of 
three  assumed  forms:  receiver  noise,  range  Independent 
noise,  or  angular  seintlllation  noise.  This  study  lumps 
all  error  sources  in  one  error  process  modelled  as  white, 
Gaussian,  and  with  constant  covariance.  The  justification 
for  ignoring  time  correlated  error  sources  such  as  angular 
scintillation  is  in  the  fact  that  most  of  the  target  depend- 
ent error  sources  --  as  scintillation,  will  be  eliminated 
if  a beacon  is  used  on  the  missile  to  aid  the  tracking 
process.  The  dominant  remaining  error  source  is  then 
receiver  noise. 

Receiver  Noise.  Receiver  noise  consists  primarily  of 
thermal  noise  generated  by  the  antenna  and  receiver  elec- 
tronics on  board  the  aircraft.  The  effective  amplitude  of 
this  noise  increases  with  Increasing  range  because  of  the 
corresponding  decreasing  signal- to-nolse  ratio.  The  noise 
bandwidth  is  dictated  by  the  post-detection  bandwidth  of 
the  receiver,  which  in  general  tends  to  be  much  larger  than 
the  signal  bandwidth.  Consequently,  it  can  be  assumed  that 
the  noise  is  "white"  over  the  signal  spectrum  of  Interest 
without  loss  of  generality.  In  the  case  of  a sampled  data 
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system,  errors  in  the  sampled  and  held  values  are  assumed 
to  be  uncorrelated  from  sample  to  sample. 

Range  Independent  Noise.  Range  independent  noise  is 
a collection  of  all  noise  sources  which  contribute  a 
constant  RMS  error  throughout  the  tracking  phase.  Typical 
sources  Include  servo  noise  generated  by  the  seeker  servo. 

It  is  assxjmed  that  the  noise  is  also  "white"  over  the 
receiver  bandwidth. 

Angular  Scintillation  Noise . Angular  scintillation 
noise  is  caused  by  the  wandering  of  the  apparent  centroid 
of  radiation  across  the  visible  surface  of  the  missile. 

This  is  generally  a narrow  band  source  and  is  often  modelled 
as  a first  order  Markov  process,  the  result  of  "white" 
noise  passed  through  a low  pass  filter  with  a time  constant 
which  depends  primarily  on  the  missile  motion  spectrxjm.  On 
the  other  hand,  if  the  radar  frequency  is  changed  in  pseudo 
random  manner  from  sample  to  sample,  then  the  apparent 
centroid  of  the  target  radiation  will  tend  to  be  independent 
from  sample  to  sample. 

Accelerometer  Specific  Force  Noise.  These  include 
accelerometer  input  axis  misalignment,  accelerometer  bias 
and  scale  factor  error,  and  higher  order  errors  (Ref  13: 
105-117).  This  study  assxjmes  a zero  bias  error.  All  the 
error  sources  in  the  accelerometers  are  then  modelled  as 
pure  white  noise.  In  most  current  generation  inertial 
navigation  systems,  the  uncompensated  accelerometer  bias  is 
at  least  50-100  yg  (Ref  13:139,163).  For  a lower  quality 
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InerCial  system,  as  the  one  which  might  be  moiinted  on  the 
missile,  a typical  value  for  the  standard  deviation  of  the 
noise  representing  this  uncertainty  would  be  1 mg. 
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Noise  Generator . The  additive  "white"  noise  for  the 
seven  measurements  (four  radar  measurements  and  three 
specific  forces)  are  produced  using  a call  to  Subroutine 
Noise  (see  Appendix  D) . The  essential  procedure  is  to 
generate  a unit  variance  Gaussian  noise  and  to  multiply  it 
by  the  strength  desired.  For  a "white"  noise,  the  strength 
is  0 (a  is  the  standard  deviation) . The  various  values  for 
the  different  strengths  are  listed  in  Table  I: 

Table  I 


Strengths  of  Measurement  Noises 


Measurement 

a 

Range  - (ft) 

10 

Range  Rate  - (ft/ sec) 

10 

Azimuth  - (Rad) 

10-3 

Elevation  - (Rad) 

o 

1 

Specific  Force  - (ft/sec^) 

32.2  • 10-3 

System  Equations 

The  equations  of  the  system  aerodynamics  and  kinematics 
are  described  in  this  section.  A state  space  representation 
is  used  for  the  development  of  the  aerodynamics  and  kine- 
matics equations . 
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Controller . As  shown  in  Fig.  1,  a controller  will  be 
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the  function  generator  for  the  conmiands  generated  in  the 
aircraft  and  transmitted  to  the  missile.  This  transmission 
is  assumed  to  be  without  loss  or  perturbation.  Two  angles 
controlling  the  aerodynamics  of  the  missile  are  transmitted 
from  the  aircraft  --  6(.  (Eq.  (10)),  and  Bg  (Eq.  (11)). 

Different  controls  are  expected  to  excite  different 
modes  of  the  system  according  to  the  various  control 
frequencies  and  natural  frequencies  of  the  system,  and  also 
to  the  state  which  is  most  perturbed  by  the  control.  Three 
different  control  types  are  used  in  this  simulation,  though 
no  attempt  is  made  to  go  into  the  broad  field  of  input 
design  — a field  \diich  investigates  the  techniques  involved 
in  choosing  the  proper  inputs  according  to  optimal  identifi- 
cation criteria  (Ref  6) . A separate  computer  simulation 
run  is  made  for  each  type  of  control.  The  specific  type  of 
control  is  defined  to  the  controller  by  the  integer  variable 
Kjj  such  that: 


Kd  - 1 = 

Pc-Ki-t 

(26) 

6c  * K3  + K4  . Sin  ((1)2  • t) 

(27) 

Kd  - 2: 

Be  ” Kl’ t + K2  • Sin  ((Di  • t) 

(28) 

«c  - K3 

. (29) 
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where  t is  the  elapsed  time  since  the  start  of  the  control- 
ling process.  K2.  K3,  and  (1)2  are  constants  which 

result  in  the  controls  described  in  Table  II. 


Kl  - 

.063 

rad/ sec 

K2  - 

.03 

rad 

K3  - 

.007 

rad 

K4  - 

.002 

rad 

“1  ■ 

.1 

rad/ sec 

“2  - 

.2 

rad/ sec 

\ 

i 


Table  II 

Control  Characteristics 


Max.  Deflection 

Amp.  of 
Oscillations 

Freq.  of 
Oscillations 

in  100  sec. 

(when  applicable) 

(when  applicable) 

Control 

(Rad) 

(Rad) 

(Hz) 

Be 

6.28 

.03 

.016 

«c 

.009 

.002 

.032 
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Aerodynamics . The  aerodynamical  characteristics  of 
the  missile  are  described  In  the  third  section  of  this 
chapter  (the  section  dealing  with  the  Missile  Guidance) . 

The  equations  are  repeated  here  for  completeness: 


q(t) 

- Mq.q(t)  + 

Mci-a(t)  + Mg -6(0 

(8) 

d(t) 

- q(t)  - 

>a(t)  - Lg* (fit) 

(9) 

«(t) 

- -X-6(t)  + 

X-fic(t) 

(10) 

B(t) 

« -v6(t)  + 

vBc(t) 

(11) 

L(t) 

- -V(t)  (d(t)  - q(t)) 

(12) 

(25) 


SF 


0 

0 

-L 


The  three  components  of  the  specific  force  vector  (SF) 
defined  In  Equation  (25)  are  In  the  missile  Inertial  frame. 

Kinematics . Since  the  position  and  velocity  states 
of  the  missile  are  defined  In  the  aircraft  frame  (as  stated 
also  In  the  radar  measurement  subsection  of  this  chapter) , 
the  specific  force  vector  has  to  be  put  Into  the  aircraft 
Inertial  frame  before  Its  Integration  to  generate  the 
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missile  velocity.  This  is  done  by  premultlplying  the 
vector  SF  by  the  misalignment  matrix  C^.  Gravity  has  to 
be  added  to  the  third  component  of  the  resultant  vector 
in  the  aircraft  frame: 


r 


A - • SF 

(32) 

X<t)  - v^Ct) 

(33) 

Y(t)  « VyCt) 

(34) 

Z(t)  - V2(t) 

(35) 

Vjj(t)  “ Ajj(t) 

(36) 

VyCt)  - AyCt) 

(37) 

V2(t)  - A2(t)  + g 

(38) 

Sianmary 

The  real  world  model  of  the  engagement  scenario's 
systems,  parameters,  and  noises  has  been  developed  in 
Chapter  II.  It  has  been  possible  to  describe  a complex, 
non-linear  system  and  simulate  it  using  a simple  rectangu- 
lar Integration  scheme  and  a fast  enough  sample  rate.  The 
modelling  emphasis  has  been  on  the  missile  system  and  its 
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associated  parameters  and  coefficients. 

The  system  eqxiatlons  were  developed  throughout  the 
chapter.  The  truth  model  flowchart  and  computer  listing 
are  in  Appendix  D.  Finally,  the  "true  states"  were 
generated  for  the  determination  of  "true"  measurement 
values  to  be  used  in  the  maximum  likelihood  estimation 
of  the  parameters  — the  three  misalignment  angles. 
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III.  Maximum  Likelihood  Filters 


Introduction 

This  chapter  presents  the  Maximum  Likelihood  Estimator 
(or  Filter)  equations  and  develops  Model  1 and  Model  2 
representations.  As  it  will  be  seen,  both  of  these  filters 
are  highly  non-linear.  Therefore,  the  conventional  Kalman 
Filter  is  not  an  appropriate  estimator  for  this  particular 
system.  In  the  case  for  which  the  covariances  of  the 
states  would  remain  Gaussian,  it  could  be  possible  to  use 
an  Extended  Kalman  Filter.  This  assumption  is  not  realistic 
for  a non-linear  system  (Ref  8:10-7).  On  the  other  hand, 
the  advantage  of  the  Extended  Kalman  Filter  is  that  it  is 
recursive  so  that  its  implementation  is  more  realizable. 
Nevertheless,  as  stated  in  the  introduction  to  this  thesis, 
the  prime  objective  is  in  the  evaluation  of  the  information 
content  of  the  two  models . The  design  of  a realizable 
filter  is  only  a secondary  objective.  For  the  non-linear 
system  at  hand,  the  maximvim  likelihood  estimator  becomes 
then  the  best  choice  because  a statistical  measure  of  the 
information  content  between  the  two  models  is  inherently 
contained  in  their  respective  terminal  information  matrix. 

Sensitivity  States 

As  shown  in  Appendix  A,  the  maximum  likelihood  estima- 
tor is  based  on  the  sensitivity  operators  made  up  of  the 
output  sensitivities,  which  are  in  turn  functions  of  the 
state  sensitivities.  The  state  sensitivities  to  the 
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misalignment  angles  are  defined  In  this  section.  The 

3P 

position  states  sensitivities  ( ^ ) are: 

0 c 
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3X 

3X 
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The  velocity  states  sensitivities  ( ^ ) are: 
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such  as  (for  example) : 


3V, 


( « N . ‘”'X 


3V 


while  the  derivative  in  time  of  is; 

o £ 


3V 


^ 3e  ^ 


3V 

I? 


(42) 


Evaluated  along  the 
nominal  path 


where  V is  the  acceleration  vector  in  the  aircraft  inertial 
frame  defined  by  Eqxiations  (36-38)  , and  £ is  the  vector 
representing  the  misalignment  angles  (Eq.  (3)). 

Using  Equations  (7) , (32) , (38) , (42)  and  the  chain 
rule  of  partial  derivatives: 


ST  5e  + 


• SF  + — 

3c  — M 3e 


(43) 
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Using  Equation  (7),  the  first  term  of  Equation  (43)  reduces 
to:  (See  Appendix  B for  detailed  derivation) 


[-SF, 

SF, 

0 ■ 

. SF  = 
3£  — 

2 

SF-^ 

0 

-SF3 

0 

-SFl 

SF2 

(44) 


where  SFj^,  SF2,  and  SF^  are  the  three  components  of  the 
specific  force  vector  SF  (defined  In  the  missile  inertial 
frame).  From  Equations  (15-18,  25)  it  is  seen  that  SF  is 
a function  of  the  missile  velocity  in  the  missile  inertial 
frame  (^)  which  is  in  turn  a function  of  the  missile 
velocity  in  the  aircraft  inertial  frame  (V^)  and  of  the 
misalignment  vector  (je)  . The  second  term  of  Equation  (43) 
expands  then  to: 


3SF 

3e 


3SF  3V^  37^  ^ 3SF  3V^ 
3^  3VA  7^  3^ 


(45) 


Equation  (43)  expands  then  to  the  following  expression 
(for  detailed  derivation  see  Appendix  B) : 


de 


^ SF  + ^ iX  + 

3e  n 


aSF  ^ X 

3\^  3£ 


(46) 
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Output  Sensitivities 

Looking  upon  the  seven  measured  values  --  four  radar 
measurements  and  three  specific  forces,  as  outputs  of  the 
system,  it  is  possible  in  a way  similar  to  the  one  used 
in  the  previous  section  to  define  the  output  sensitivifies 


< If  ^ 


3R 

3R 

3R 

dill 

36 

3<|> 

IE 

3R 

dip 

36 

3^ 

3Sin4'j^ 

3Sln<|;j^ 

dip 

36 

3(^ 

9Sin6^ 

3Sin6j^ 

3Sin6{^ 

36 

3([) 

3SFi 

3SF2^ 

3<|> 

36 

3<|) 

3SF2 

3SF2 

3SF2 

3<|> 

36 
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3SF3 

3SF3 

3SF3 

dip 

36 
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Using  the  chain  rule  of  partial  derivatives,  the  elements  of 


are  derived  as  follows  --  using  Equations  (19-23) , (25) ; 
9 6 
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Since  there  is  a nominal  state  trajectory  that  remains  un- 
perturbed, small  scale  sensitivities  are  used  here. 

SF2,  and  SF^  are  the  specific  force  measurements  received 
directly  from  the  missile. 

Kodel  1 uses  the  three  measured  specific  forces  as 
Inputs  for  the  generation  of  its  trajectory.  Hence,  they 
are  not  treated  as  measurements  of  the  states  as  it  will  be 
done  in  Model  2.  As  shown  in  Appendix  A,  the  difference 
between  the  "true”  measurement  vector  and  the  one  generated 
from  the  model  trajectory,  plays  an  important  role  in  the 
determination  of  the  gradient  vector.  In  the  case  of 
Model  1,  such  a difference  would  not  exist  for  the  three 
components  of  the  measurement  vector  constituting  the 
three  specific  forces.  Therefore,  for  the  case  of  Model  1, 
the  dimension  of  the  measurement  vectors,  "true"  and  mod- 
elled, is  reduced  to  four  and  Includes  only  the  radar 
measurement . 

The  calculations  of  the  information  matrix  and  of  the 
gradient  vector  as  described  in  Appendix  A Include  only 
the  measurement  noise  covariance  R.  This  is  correct  when 
it  is  assumed  that  there  is  no  plant  noise  in  the  system, 
or  that  it  is  at  least  negligible.  Model  1 uses  the 
specific  forces  received  through  the  aircraft's  communica- 
tion system  as  inputs  to  the  generation  of  the  estimated 
trajectory.  As  stated  in  Chapter  II,  Gaussian  white  noise 
is  added  to  the  measurements  before  they  are  transmitted  to 
the  aircraft.  This  essentially  means  that  the  assumption 
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about  the  zero  plant  noise  Is,  in  fact,  not  valid  for 
Model  1.  This  study,  nevertheless  uses  the  assiimption  of 
zero  plant  noise.  Since  the  comparison  of  the  information 
matrices  between  Model  1 and  Model  2 is  seeked,  they  should 
be  compared  on  a direct  basis  (both  without  plant  noise) . 
However,  if  one  were  to  build  the  estimator  using  the 
Model  1 approach,  he  would  have  to  include  plant  noise  in 
the  maximum  likelihood  estimator. 

Model  2 

As  stated  in  the  Introduction  to  this  thesis.  Model  2 
is  an  upgraded  model  as  compared  to  Model  1,  in  that  it 
does  account  for  the  specific  forces  measured  by  the  missile 
accelerometers,  being  a function  of  the  misalignment  angles. 
The  difference  between  Model  1 and  Model  2 lies  then  in  the 
second  term  of  Equation  (43)  which  appears  only  in  the  case 
of  Model  2. 

Model  2 does  not  use  the  specific  forces  of  the  missile 
transmitted  to  the  aircraft  as  Inputs  to  the  generation  of 
the  expected  trajectory  (as  Model  1 does).  As  mentioned 
in  the  introduction,  since  the  characteristics  of  the 
missile  are  known  to  the  aircraft's  computer,  expected 
specific  forces  can  be  generated  (using  the  nominal  expected 
misalignment  angles)  and  used  as  inputs  to  the  generation 
of  the  expected  trajectory.  Those  specific  forces  are 
then  compared  to  the  one  transmitted  from  the  missile  in 
the  process  of  building  the  gradient  vector  needed  for  the 
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estimation  of  the  misalignment  angles.  The  output 
(measurement)  vectors,  "true"  and  estimated,  for  Model  2, 
have  then  a dimension  of  seven.  On  top  of  the  four  radar 
measurements,  the  three  specific  forces  are  now  added  to 
the  measurement  vector.  In  contrast  to  what  was  said  in 
the  case  of  Model  1,  the  assiimptlon  of  zero  plant  noise 
for  Model  2 is  correct. 

It  can  be  seen  that  Model  2 is  indeed  using  an  inherent 
source  of  information  (at  the  price  of  additional  complexity) . 
As  stated  in  the  introduction,  the  main  thrust  of  this  study 
is  to  determine  if  the  additional  complexity  is  worth  the 
degree  of  information  added  to  the  model.  It  should  also 
be  noted  that  the  predicted  states  in  Model  2 are  a far 
more  non-linear  function  of  the  error  angles  e than  they 
are  in  Model  1,  Thus,  in  going  from  Model  1 to  Model  2, 
plant  noise  has  been  traded  for  significant  non-linearities. 
Both,  as  it  will  be  seen,  can  cause  considerable  difficul- 
ties in  the  prediction  and  estimation  capabilities. 

Information  Matrix 

The  first  sections  of  this  chapter  have  derived  what 

is  called  in  the  literature  a "sensitivity  system"  (Refs  6, 

14,  15) . The  states  of  this  system  are  the  position  and 

velocity  sensitivities  ( ^ , ^ ) and  the  outputs  are  the 

0 C 9 £ 

output  sensitivities: 

/■  3R  3R  3(Sint|)R)  3(SineR)  3SFi  3SF2  3SF3 

3e  3e  3e  3e  3£  3e  3e 


r f 


Once  the  output  sensitivities  have  been  evaluated, 
the  information  matrix  can  be  derived.  The  information 
matrix  is  in  fact  (Appendix  A) : 


M 


N 
- Z 

n“l 


3e 


( il) 
ae 


(53) 


Using  the  output  sensitivities  and  the  difference  between 
the  "true"  output  vector  versus  the  estimated  one,  the 
gradient  vector  is  evaluated: 


“ "n^l  ^ If  ' 2est.> 


(54) 


The  role  played  by  the  output  sensitivities  in  the  building 
of  the  information  matrix,  and  the  gradient  vector,  and  in 
the  estimation  process  is  clearly  important.  Sensitivities 
can  be  analogous  to  signal  strength  and  the  Information 
matrix  --to  signal  to  noise  ratio.  Then  by  making  sensi- 
tivities large,  the  signal  to  noise  ratio  can  be  increased 
thereby  enhancing  the  estimation  capability.  The  next  step 
is  to  evaluate  the  correction  in  the  estimation  of  the 
misalignment  angles.  As  stated  in  Appendix  A,  this  cor- 
rection is: 


5e  - M-1h 


(55) 
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Performance  Criteria 


In  view  of  the  prime  objective  of  this  study  — the 
comparison  of  the  information  matrices  for  Model  1 and 
Model  2,  this  comparison  is  by  itself  a performance 
criterion.  The  comparison  is  based  on  the  trace  of  the 
"dispersion  matrix"  defined  as  the  inverse  of  the  informa- 
tion matrix: 


tr(d)  = tr  (M"^) 


(56) 


In  view  of  the  secondary  objective  — the  estimation  of  the 
misalignment  angles,  the  quality  of  this  estimation  (how 
close  do  the  estimated  angles  get  to  the  true  angles) , 
is  another  performance  criterion. 

As  shown  in  Appendix  A (Eq.  (A-10)),  the  estimation 
process  includes  in  fact  a linearization  about  a nominal 
trajectory  (defined  by  a nominal  estimated  misalignment 
angle  vector).  Therefore,  generally  speaking,  the  estima- 
tion process  should  be  iterative  and  hopefully  convergent. 
Each  iteration  uses  the  measurements  of  the  full  tracking 
period.  The  estimation  is  then  reprocessed  about  the 
corrected  nominal  path  so  that  the  estimated  misalignment 
angles  vector  gets  as  close  as  possible  to  the  "true" 
vector.  Three  iterations  were  made.  In  the  case  of  Model 
1,  the  specific  forces  transmitted  from  the  missile  (and 
which  are  the  source  for  the  generation  of  the  estimated 


trajectory)  are  assiimed  not  to  be  functions  of  the  mis- 
alignment angles.  Disregarding  gravity,  Model  1 trajectory 
is  described  by: 


P 

V 


0 

0 


0 

e 


SF 


(57) 


\diere  ^ is  assianed  not  to  be  a function  of  £,  1 is  the 
identity  matrix,  P is  the  position  vector  and  V is  the 
velocity  vector. 

It  is  then  clear  that  the  system  can  in  fact  be 
reformulated  such  that  the  misalignment  angles  are  states 
(modelled  as  random  biases)  in  the  augmented  system  (W 
is  the  pseudo-noise  which  would  be  added  if  an  Extended 
Kalman  Filter  was  to  be  used) : 


(58) 


Presuming  that  the  P vector  is  directly  measurable  (i.e. 
there  exists  a one  to  one  correspondence  between  the 
position  vector  and  the  radar  measurement  vector)  then  it 
can  be  shown  that  the  position  covariance  can  be  calculated 
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IV.  Results  and  Conclusions 


Introduction 

As  stated  In  the  Introduction  to  this  study  and  in 
Appendix  A,  the  maximum  likelihood  estimation  is  based  on 
the  evaluation  of  state  and  output  sensitivities  with 
respect  to  unknown  parameters  --  the  misalignment  angles  — 
while  the  missile  follows  a nominal  trajectory.  This 
nominal  trajectory  is  a function  of  the  parameters,  the 
type  of  control  applied  to  the  missile,  and  time  (Eq.  (A-1)). 

The  complete  set  of  numerical  results  is  gathered  in 
Appendix  C.  Tables  C-I  to  C-VI  describe  the  trajectories 

f 

for  the  Truth  Model.  Tables  C-I  to  C-III  show  the  nominal  ' 

path  for  the  arbitrary  set  of  misalignment  angles: 

» 1 mrad 
0 « 2 mrad 
({)  » 3 mrad 


but  with  three  different  types  of  control.  Likewise,  Tables 
C-IV  to  C-VI  show  the  nominal  path  for  a different  set  of 
arbitrary  misalignment  angles: 

,i 


^ * 5 mrad 
e B 10  mrad 
d)  - 15  mrad 


and  again,  with  three  types  of  control. 

The  two  angles  3^  and  6^  are  transmitted  from  the  air- 
craft to  the  missile.  Using  them,  the  aircraft  in  fact 
controls  the  missile.  As  described  in  the  section  of 
Chapter  II  dealing  with  the  controller,  3^  is  the  bank 
angle  command  while  6^  is  the  control  surface  deflection 
command.  The  control  characterized  by  Kq  = 1 is  described 
by: 


Ki*t 

(26) 

K3  + K4»Sin(u2*t) 

(27) 

Specific  values  for  the  various  constants  are  given  in 
Chapter  II.  For  the  second  type  of  control  (Kp  = 2)  the 
commanded  angles  are: 


3q  = Ki»t  + K2*Sin(a)i»  t)  (28) 

6c  * ^3  (29) 


Finally,  the  third  type  of  control  is  described  by; 
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3g  - Ki‘t  + K2*Sin(wi*t)  (30) 

6c  - K3  + K4*Sin(a)2*t)  (31) 

In  all  cases,  the  simulation  starts  when  the  relative 
position  of  the  missile  with  respect  to  the  aircraft  is: 


X(0)  » 1000  ft 
Y(0)  *=  1000  ft 
Z(0)  * 100  ft 


The  range  (R)  measured  by  the  radar  is  then  (without  noise) : 


R(0)  = 1417.7  ft 


The  relative  velocity  of  the  missile  with  respect  to  the 
aircraft  at  the  beginning  of  all  simulations  is: 

Vx(0)  » 2000  ft/ sec 
Vy(0)  - 1500  ft/sec 
V2(0)  = 10  ft/sec 
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The  range-rate  ( R ) measured  by  the  radar  is  then  (with- 
out noise) : 

R(0)  » 2469.4  ft/sec 

At  the  beginning,  before  any  commands  are  transmitted  to 
the  missile,  its  accelerometers  are  assumed  to  be  measuring 
no  specific  force.  Tables  C-I  to  C-VI  show  the  missile 
relative  position  and  velocity,  its  range  and  range-rate 
and  its  specific  forces  every  10  seconds  for  the  50  sec- 
onds during  which  the  missile  is  tracked.  It  is  seen  that 
the  range  between  the  aircraft  and  the  missile  at  the  end 
of  the  30  seconds  is  about  22  nautical  miles.  This  repre- 
sents a conservative  range  at  which  most  modem  airborne 
fire  control  radars  would  still  be  able  to  beacon  track  a 
target . 

As  stated  in  Appendix  A,  the  trace  of  the  dispersion 
matrix  (which  is  the  inverse  of  the  information  matrix) 
was  chosen  as  the  primary  measure  of  merit  in  comparing  the 
two  different  modelling  techniques.  Additionally,  using 
the  dispersion  matrix  and  the  gradient  vector,  a new  ^ 

estimate  of  the  misalignment  angles  vector  is  computed  and 
printed  together  with  the  trace  of  the  dispersion  matrix 
every  10  seconds. 
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Using  Equation  (A-10) , It  Is  possible  to  express 
each  of  the  output  differences  (true  measured  output  minus 
estimated  output)  as  the  sum  of  three  terms: 

Ay  “ If  + n + HOT(y)  (59) 

^ere  Ay  denotes  the  output  difference,  — the  sensiti- 
vity of  this  particular  output  to  the  misalignment  angles 
vector  £,  A£  — the  actual  misalignment  (for  the  current 
Iteration),  q — the  measurement  noise,  and  HOT(y)  — the 
higher  order  terms  In  the  Taylor's  series  expansion  used 
for  the  linearization  process.  It  Is  Important  to  note 
that  In  the  "noisy"  cases  the  HOT  terms  and  the  noise  are 
lumped  together.  Therefore,  In  order  to  appraise  the  quality 
of  the  linearization  (how  much  Is  neglected  In  the  higher 
order  terms)  one  has  to  look  at  the  results  generated  for 
the  cases  without  noise.  In  those  cases,  an  examination  of 
the  HOT  terms  gives  a direct  evaluation  of  the  local  accur- 
acy of  the  linearization  process.  Indeed,  if  the  HOT  term 
becomes  a significant  percentage  of  the  first  order  sensi- 
tivity term,  it  would  be  expected  to  have  a poor  estimation 
capability  (in  one  iteration)  in  spite  of  the  fact  that  the 
dispersion  matrix  might  be  very  small  at  that  point.  There- 
fore, the  dispersion  matrix  alone  will  not  supply  the  entire 
basis  of  comparison  of  the  two  methods  as  these  other  Indi- 
cators must  also  be  considered. 
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Model  1 Results 


The  results  of  the  simulation  using  Model  1 are  shown 
In  Tables  C-VII  to  C-XXXIII.  In  the  case  of  Model  1,  the 
output  vector  consists  of  the  range  between  the  aircraft 
and  the  missile,  the  range  rate,  the  sine  of  the  azimuth 
angle,  and  the  sine  of  the  elevation  angle.  The  difference 
between  the  estimated  and  actual  output  values  are  calcu- 
lated and  printed  every  10  seconds.  Next  to  those  differ- 
ences, the  appropriate  HOT  terms  are  also  printed. 

Comparing  the  trace  of  the  dispersion  matrix  conver- 
gence between  the  various  Iterations  and  with  any  type  of 
control  It  is  seen  that  the  trace  Indeed  gets  smaller  as 
the  amount  of  Information  Increases  with  time.  Table  III 
shows  as  an  example  the  case  without  noise  and  with  = 3, 
for  the  first  and  third  Iteration. 


Table  III 

Model  1 --  Decrease  of  the  Trace  of  the 
Dispersion  Matrix  (First  and  Third  Iteration) 


Time 

(sec) 

Trace  of  Dispersion  Matrix 

First  Iteration  Third  Iteration 

10. 

.186*10"^ 

.186- 10"^ 

20. 

.188*10"3 

.189*10-3 

30. 

.942-10"5 

.942*10-3 

40. 

.210-10-5 

.208*10-3 

50. 

.750‘10"^ 

.736*10-3 

J 

I 

i 

I 
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In  the  case  of  Model  1,  the  system  is  In  fact  linear  — 
augmenting  the  system  by  looking  at  the  misalignments  as 
states  (Eqs.  (56)  and  (57)).  Therefore,  there  Is  no  more 
advantage  In  redoing  the  estimation  In  more  than  one  Itera- 
tion. Indeed,  comparing  Tables  C-VII  to  C-XXXIII  between 
Iterations,  It  Is  seen  that  the  convergence  of  the  trace  of 
the  dispersion  matrix  almost  does  not  change  from  one  Itera- 
tion to  the  next  (Table  III) . This  is  basically  due  to  the 
fact  that  the  state  sensitivities  In  Model  1 are  Independent 
of  the  nominal  parameter  values  selected  (i.e.,  the  state 
sensitivities  do  not  change  when  the  parameter  values  change) . 

The  radar  measurements  are  non-linear  functions  of  the 
relative  position  and  velocity  of  the  missile  (as  stated  In 
the  section  of  Chapter  II  dealing  with  the  radar  measure- 
ments) . Therefore,  the  output  differences  are  expected  to 
decrease  from  one  Iteration  to  the  next,  and  Indeed  they  do 
(Tables  C-VII  to  C-XV) . The  higher  order  terms  are  seen  to 
be  Increasing  due  to  the  output  (and  output  differences) 
being  non-linear.  Table  IV  shows  for  example,  the  values 
for  the  range  difference  and  HOT  term  for  the  first  and 
second  Iteration  of  the  case  without  noise  and  with  Kjj  = 3. 

In  the  noisy  cases  (Tables  C-XVI  to  C-XXIV)  the  output 
differences  are  not  seen  to  be  decreasing  anymore  (from  one 
Iteration  to  the  next).  The  reason  Is,  of  course,  the  noise 
which  is  now  added  to  the  output  and  which  can  be  seen  ex- 
clusively at  the  Initial  time  for  each  output  difference 
(Table  V) . 


Table  IV 

Model  1 — Range  Difference  and  HOT 


Iteration 

1 

Time 

! DELTA  (R) 

HOT(R) 

# 

(sec) 

1 (ft) 

(ft) 

10 

1 

• 

»-• 

00 

.47-10‘2 

20 

.39 

.41*10-1 

1 

30 

-.67 

.12 

40 

-.64 

.23 

50 

-.21 

.37 

10 

-.31‘10’2 

.79-10-7 

20 

-.42* 10"^ 

.78-10-6 

2 

30 

-.12 

.24-10-5 

40 

-.23 

.52-10'5 

50 

-.37 

.90-10’5 

Table  V 

Measurement  Noise 


Output 

Variance 

Actual  Added  Noise 

Range  (ft) 

10 

11.25 

Range  Rate  (ft/ sec) 

10 

9.21 

Azimuth  (mrad) 

1 

1.56 

Elevation  (mrad) 

1 

.90 
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For  the  same  reason,  the  higher  order  terms  do  not  appear  to 
be  lower  than  the  output  differences  anymore. 

The  errors  made  In  estimating  the  misalignment  angles 
are  seen  to  decrease  remarkably  (by  4 to  6 orders  of  magni- 
tude) from  one  Iteration  to  the  other  In  the  no-nolse  cases. 
Table  VI  shows  the  evolution  of  this  error  for  the  estima- 
tion of  the  misalignment  angle  ip  after  50  seconds  for  a no- 
nolse  case  (with  Kp  = 3) . 


Table  VI 

Model  1 — ip  Estimation  Error  (No  Noise) 


Iteration 

Iteration 

Iteration 

#1 

n 

#3 

-.12-10"1 

-.24*10‘6 

-.55*10-9 

On  the  other  hand,  In  the  noisy  cases,  the  estimation  errors 
seem  to  stay  more  or  less  constant  from  one  Iteration  to 
the  next.  Table  VII  shows  the  evolution  of  this  error  for 
the  estimation  of  the  misalignment  angle  \l)  for  a noisy  case 
(with  Kj)  = 3)  after  50  seconds. 


Table  VII 

Model  1 --  \l>  Estimation  Error  (With  Noise) 
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The  reason  that  these  errors  stay  essentially  constant  is 
that  the  presence  of  the  noise  in  the  measurements  tends  to 
create  a bias  in  the  estimation  error.  This  result  was,  in 
fact,  expected  out  of  a single  run  of  a "Monte  Carlo  simu- 
lation" as  conducted  in  this  study  (even  though  the  addi- 

i 

tive  measurement  noise  was  specified  as  zero  mean) . 

The  ability  of  the  estimator  to  estimate  the  mis-  ^ 

alignment  angles  was  checked  for  the  angles  1,  2,  and  3 I 

i 

milliradians . Tables  C-XXV  to  C-XXXIII  include  the  results  j 

for  the  case  in  which  the  misalignment  angles  are  5,  10,  ] 

and  15  milliradians.  Table  VIII  (K^  = 3,  with  noise) 
shows  that  the  performance  of  the  estimator  was  not  de- 
graded in  this  case.  No  attempt  has  been  made  to  check  for 
the  maximxmi  misalignment  angles  which  can  still  be  estimated 
adequately  using  this  small  angle  approximation  model. 


Table  VIII 

Model  1 Estimation  Ability 


Misalignment  Angles 

Estimation  Error 

(mrad) 

\|^  e (|) 

(yrad) 

12  3 

5 10  15 

-11.  -21.  -47. 

-10.  -21.  -48. 

Model  2 Results  I 

^ 

The  results  of  the  simulation  using  Model  2 are  in-  i 

eluded  in  Tables  C-XXXIV  to  C-LX.  In  the  case  of  Model  2, 
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the  output  vector  consists  of  the  four  radar  tracking  com- 
ponents Included  In  Model  1 as  well  as  the  three  specific 
forces  which  are  now  regarded  as  measurements  to  be  com- 
pared to  the  predicted  values  of  the  specific  forces. 

Comparing  the  trace  of  the  dispersion  matrix  between 
the  various  Iterations  and  with  any  type  of  control,  It 
Is  seen  that  the  trace  Indeed  gets  smaller  as  the  amount  of 
Information  Increases  with  time.  On  the  other  hand,  the 
trace  stays  essentially  the  same  from  one  Iteration  to  the 
next  (Table  IX) . 


Table  IX 

Model  2 --  Decrease  of  the  Trace  of  the 
Dispersion  Matrix  (First  and  Third  Iteration) 


Time 

(sec) 

Trace  of  Dispersion  Matrix 

First  Iteration  Third  Iteration 

10. 

.46-10‘^ 

.47-10‘^ 

20. 

.72.10'^ 

.68«10‘^ 

30. 

.44* 10-^ 

.42.10-^ 

40. 

.96*10"^ 

.90.10"^ 

50. 

.46-10‘5 

.43-10*5 

Comparison  of  the  estimation  errors  show  that  they  seem 
to  Increase  with  time  within  each  Iteration.  The  reason 
for  this  Is  In  the  non-llnearltles  which  are  Inherent  to 
Model  2.  The  error  made  In  neglecting  the  higher  order 
terms  In  the  process  of  linearization,  builds  up  In  time 
and  deteriorate  the  validity  of  the  linearized  model.  The 


closer  the  estimated  misalignment  angles  are  from  the  true 
ones,  the  longer  the  linearization  stays  valid  and  the 
error  in  the  estimate  decreases.  Table  C-XL-b  (first 
iteration),  for  example,  shows  a minimum  estimation  error 
occurring  after  10  seconds  while  Table  C-XLII-b  (third 
iteration)  shows  a minimum  estimation  error  occvirring  after 
20  seconds. 

As  in  Model  1,  the  output  differences  are  non-linear 
functions  of  the  relative  position  and  velocity  of  the  mis- 
sile. The  higher  order  terms  therefore  increase  accordingly; 
they  are  still  smaller  than  the  appropriate  output  difference 
after  10  seconds  on  the  first  iteration  but  later  on  they 
Increase.  As  the  non-linearity  decreases  in  significance 
on  the  second  iteration  (the  nominal  misalignment  being 
closer  to  the  "true"  one) , they  are  now  seen  to  stay  below 
the  output  differences  during  all  the  tracking  period. 

Table  X shows,  for  example,  the  values  for  the  range  dif- 
ference and  HOT  term  for  the  first  and  second  iteration  of 
the  case  without  noise  and  with  Kp  - 3.  It  is  seen  that  on 
the  first  iteration  after  10  seconds  the  HOT  term  is  still 
smaller  than  the  output  difference  by  two  orders  of  mag- 
nitude but  later  it  becomes  bigger  and  closer  to  the  range 
difference.  On  the  second  iteration  the  HOT  term  remains 
smaller  than  the  output  difference  than  it  was  in  the  first 
iteration. 

As  in  Model  1,  here  too,  the  additive  measurement  noise 
masks  any  decrease  in  the  output  differences  seen  before 
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I Table  X 

[ Model  2 — Range  Difference  and  HOT 


Iteration 

Time 

(sec) 

DELTA  (R) 

(ft) 

HOT(R) 

(ft) 

10 

-.11 

-.95-10-3 

20 

-.34 

.42*10-1 

1 

30 

-.17*10^ 

.30 

40 

-.36*10^ 

.15-10^ 

50 

-.63*10^ 

.51-10l 

10 

.89*10‘2 

.15-10-2 

20 

-.37-10-1 

-.41-10-2 

2 

30 

00 

CM 

• 

1 

-.39*10-1 

40 

-.17-10^ 

-.22 

50 

-.56*10l 

-.88 

from  one  iteration  to  the  next.  Tables  C-XLIII  to  C-LX 
include  the  results  for  the  noisy  cases.  Table  V which 
shows  the  additive  measurement  noise  as  it  appears  at  the 
initial  time  of  each  iteration,  applies  to  Model  2 too. 

This  is  because  the  same  pseudo-random  sequence  is  used 
for  the  generation  of  the  additive  noise  in  both  models. 

The  ability  of  the  algorithm  to  estimate  misalignment 
angles  was  checked  for  the  angles  1,  2,  and  3 milliradians . 
The  results  are  Included  in  Tables  C-XXXIV  to  C-LI.  The 
errors  made  in  estimating  the  misalignment  angles  are  seen 
to  decrease  from  one  iteration  to  the  next  in  the  no-noise 
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cases.  Table  XI  shows  the  evolution  of  this  error  for  the 
estimation  of  the  misalignment  angle  ij/  after  50  seconds  for 
a no-noise  case  (with  Kjj  = 3)  . 


Table  XI 

Model  2 — Estimation  Error  (No  Noise) 


Iteration 

n 

Iteration 

n 

Iteration 

#3 

-.63 

.14 

-.31*10"^ 

On  the  other  hand,  in  the  noisy  cases,  the  estimating  errors 
seem  to  stay  essentially  constant  from  one  iteration  to  the 
next.  Table  XII  shows  the  evolution  of  this  error  for  the 
estimation  of  the  misalignment  angle  ip  for  a noisy  case 
(with  Kjj  » 3)  after  50  seconds. 

Table  XII 

Model  2 --  Ip  Estimation  Error  (With  Noise) 


Iteration 

#1 

Iteration 

#2 

Iteration 

#3 

.85*10-1 

-.19*10"1 

-.14*10-1 

It  is  seen  that  the  errors  stay  more  or  less  constant  and 
the  reason  for  it  is  as  stated  in  the  case  of  Model  1 — 
the  additive  noise. 


Tables  C-LII  to  LX  Include  the  results  for  the  case  in 
which  the  misalignment  angles  are  5,  10,  and  15  milliradians. 
Table  XIII  (Kq  - 3,  with  noise)  shows  that  the  performance 


of  the  estimator  was  not  degraded  in  this  case.  No  attempt 
has  been  made  to  check  for  the  maximum  misalignment  angles 
which  can  still  be  estimated  adequately  using  this  small 
angle  approximation  model. 

Table  XIII 

Model  2 Estimation  Ability 


Misalignment  Angles 

6 (j) 

(mrad) 


Estimation  Error 

6 (j) 

(urad) 


Models  Comparison 

Model  1 is  definitely  simpler  in  its  concept  than 
Model  2.  Model  2 was  expected  to  perform  better  in  the 
misalignment  angles  estimation  since  it  inherently  tried 
to  incorporate  more  apriori  knowledge  in  the  estimation  — 
i.e.,  it  had  more  information  content.  Comparing  the  per- 
formance of  Model  1 and  Model  2 for  similar  cases  (for 
example,  = 3 with  noise)  it  is  seen  that  the  two  dif- 
ferent models  estimate  the  misalignment  angles  with  errors 
as  given  in  Table  XIV. 

Comparing  the  "information  content"  of  Model  1 and  2, 

It  is  seen  that  Model  2 (as  expected)  draws  more  information 
from  the  measurements.  This  is  observed  from  the  comparison 


r 


1 


Table  XIV 

Estimation  Error  Comparison 


Model 

1 Error 

6 

(yrad) 

<P 

Model 

4' 

2 Error 

0 

(yrad) 

<l> 

Iteration 

#1 

-16. 

-20. 

-46. 

85. 

-170. 

-140. 

Iteration 

#3 

-11. 

-21. 

-46. 

-14. 

- 24. 

- 28. 

of  the  traces  of  the  dispersion  matrices  as  shown  In  Table 
XV  (Kjj  = 3 with  noise)  . 


Table  XV 

Trace  of  Dispersion  Matrix  Comparison 


Time 

(sec) 

Model  1- Trace  of 
Dispersion  Matrix 

Model  2 -Trace  of 
Dispersion  Matrix 

10 

.19*10"^ 

.17*10"^ 

20 

.29‘10"^ 

.14*10“^ 

30 

.33‘10'^ 

.38*10‘6 

40 

.64- 10'^ 

.17*10"6 

50 

.21*10-6 

.11*10'^ 

Conclusions 

In  regard  to  the  prime  objective  of  this  study  — 
the  comparison  of  the  information  content  of  the  two  models, 
it  is  clear  that  Model  2 starts  indeed  with  a higher  level 
of  information  than  Model  1 (see  the  traces  of  the  dispersion 
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matrix  at  10  sec.  in  Table  XV),  but  they  both  tend  to 
approximately  equal  Information  after  50  seconds  of  track- 
ing. 

In  regard  to  the  estimation  objective.  Model  1 appears 
to  be  much  more  advantageous  than  Model  2.  It  is  not  only 
simpler  (uses  only  65  seconds  of  the  CDC  6600  central 
processor  time  to  be  executed  in  the  noisy  case  for  Kp  = 3, 
versus  145  seconds  for  the  case  of  Model  2) , but  it  also 
does  not  require  many  iterations  to  take  care  of  inaccuracies 
caused  by  the  linearization  process. 

The  HOT  terms  are  in  fact  an  indicator  of  the  quality 
of  the  linearization  process  which  turns  out  to  be  much 
better  in  the  case  of  Model  1 than  in  Model  2 (this  is  seen 
from  general  trends  and  orders  of  magnitude  in  Tables  IV 
and  X) . The  final  results  of  the  estimation  are  also  very 
comparable  between  Model  1 and  Model  2 (Table  XIV) . There- 
fore, it  can  be  said  that  in  the  process  of  parameters 
estimation,  it  is  not  enough  to  look  at  the  trace  of  the 

dispersion  matrix  and  one  has  also  to  be  concerned  about 

Ji 

the  quality  of  the  linearization. 

Finally,  it  has  been  seen  that  to  the  limited  extent 
at  which  it  was  evaluated  neither  the  size  of  the  initial 
misalignment  angles  nor  the  various  input  control  had  any 
major  influence  on  the  results. 


Suggested  Future  Study 

This  study  can  really  be  characterized  as  a feasibility 
study  meant  to  investigate  the  amount  of  information  included 
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I 

in  each  one  of  the  two  methods  checked.  Expanding  the 
feasibility  issue,  one  could  investigate,  in  ntuch  greater 
depth  than  was  done  in  this  study,  the  broad  field  of  input 
design  applied  to  this  problem.  In  this  way,  one  could  try 
to  optimize  the  inputs  in  order  to  get  maximum  sensitivi- 
ties — or  in  other  words,  maximum  information  — to  optimize 
the  estimation  accuracy. 

p| 

I Another  prospective  subject  of  investigation  is  the 

i influence  of  different  initial  error  on  the  estimation 

I 

|j  accuracy  as  a function  of  time. 

;! 

fi  Using  a Monte  Carlo  analysis,  one  could  investigate 

■i 

the  difference  in  the  two  models  between  the  trace  of  the 

, I 

ij  dispersion  matrix  and  an  error  ellipsoid  for  the  misalign- 

I 

I ment  angles  variances. 

i 

Finally,  expanding  this  study  in  the  direction  of 

ii  implementation,  one  could  use  Model  1 for  example,  and  try 

i 

to  design  a realistic  estimator  without  ass\miing  zero  plant 
noise  (as  it  was  done  in  this  study)  and  without  assximing 
perfect  knowledge  of  the  Initial  conditions. 


1 
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Appendix  A 

Sensitivity  Operators  and  Maximum 
Likelihood  Parameter  Estimation 

For  many  applications  of  Interest,  Including  the  case 
dealt  with  In  this  study,  various  techniques  can  be  used 
to  produce  an  adequate  system  description  In  the  form  of 
a linear  system  model  driven  by  known  Inputs  and  white 
Gaussian  noises.  Using  this  linear  system  model.  It  Is 
possible  to  develop  an  optimal  state  estimator  and/or 
controller.  However,  the  optimality  of  these  devices  Is 
dependent  upon  complete  knowledge  of  the  parameters  which 
defined  the  best  model  for  system  d3mamlcs,  output  relations, 
and  statistical  description  of  uncertainties.  Thus,  in  order 
to  Improve  the  quality  of  the  state  estimates.  It  would  be 
desirable  to  estimate  the  unknown  parameters  In  an  online 
fashion.  For  the  problem  considered  in  this  thesis,  this 
would  be  the  three  misalignment  angles  of  the  platform  of 
the  missile.  This  is  often  termed  combined  state  estima- 
tion and  system  identification  (Ref  8:10-1).  The  concept 
of  maximum  likelihood  estimation  Is  used  when  estimating 
the  parameters  without  any  aprlorl  statistics  but  assuming 
that  even  though  they  are  unknown,  the  parameters  are 
practically  constant  (Ref  16:40-42,  7:156-157). 

The  system  can  be  described  by  the  following  vector 
linear  differential  equation: 
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I, 


The  measurement  vector  is  described  by: 


y(t,b,u)  - H(x,b,u)  X(t,u)  + n(t)  (A-2) 


where  X(t)  is  an  n-  dimensional  state  vector,  u(t)  is 
an  r-dlmenslonal  control  input,  y(t)  is  an  m-dimenslonal 
output  vector,  and  b is  a p-^dimensional  real  parameter 
vector  which  parametrizes  the  matrices  A and  B and  the 
initial  condition  vector  d.  It  can  be  seen  that  the  system 
described  here  is  less  than  the  most  general  one  since  it 
assumes  no  plant  noise  so  that  the  only  uncertainty  present 
is  in  the  measurements  — n(t) . The  measurement  noise  is 
modelled  as  additive  noise. 

It  is  assumed  that  the  matrices  A,  B,  and  H are  con- 
tinuously differentiable  with  respect  to  the  individual 
components  bj^  at  a nominal  value  of  the  parameter  vector 
bQ.  Then  the  state  sensitivities  may  be  computed  from 
the  so-called  "sensitivity  system": 


r ' 


X(t,u)  - A X(t,u)  + B u(t) 


M) 


(A-3) 


The  measurement  sensitivity  vector  is: 


7(t,u)  » ff  X(t,  u) 


(A-4) 


where  X(t,u)  is  a ((1  + P)  x n) -dimensional  state  sensi- 
tivity vector,  and  7(t,u)  is  a ((1  + P)  x m) -dimensional 
output  sensitivity  vector.  The  control  input,  u,  is 
assumed  to  be  fixed  and  completely  known.  Therefore,  to 
emphasize  that  the  control  is  fixed,  the  explicit  depend- 
ency of  the  system  output  (measurement  vector)  upon  the 

A 

control,  u,  will  be  deleted,  bg  denotes  an  apriori  estimate 

A 

of  b and  y(bQ)  denotes  the  corresponding  mathematical  model 
output  function.  The  system  output  sensitivities 
v(i),  i - 1,  ...p  are  defined  as  the  p m- dimensional  output 
sensitivity  vectors,  and  they  are  assxuned  to  be  evaluated 
along  the  mathematical  model  output  and  to  exist  and  be 

A 

continuous  for  all  b. 

The  estimation  criterion  adopted  is  the  commonly 
used  output  error  functional: 
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Jg(b)  -^|^{(z(t)  - 2(b,t))^R'^(x(t)  - x(b,t))}dt  (A-5) 


where  ^ Is  the  vector  of  actual  true  measurements  and  R"^ 
is  the  Inverse  of  the  covariance  of  the  zero-mean  additive 
white  Gaussian  measurement  noise: 


E(Ti(t)  n^Cx))  =>  R"^(t)  6(t~T) 


(A-6) 


where  E(»)  is  the  expectation  operator,  and  5(»)  is  the 
unit  sampling  fxmction  defined  by  6(t)  = 0 for  t = 0,  and: 


/ 6(t)  g(t)  dt  = g(0) 


(A-7) 


for  any  arbitrary  fxmction  g.  The  superscript  T denotes 

A 

the  transpose  of  a vector.  The  best  estimate,  bop^^,  is  then 

A ^ 

the  b which  minimizes  Je(b) . 

Since  the  existence  and  continuity  of  the  sensitivity 
operators  at  bQ  are  assumed,  the  true  system  output,  may 

A 

be  linearized  about  the  nominal  output  y^(bQ)  , through  the 
generalized  Taylor's  formula  as  follows: 


L 


This  equation,  although  quite  simple,  is  of  fundamental 
importance  as  it  clearly  demonstrates  the  importance  of 
the  sensitivity  operator  in  the  parameter  identification 
problem.  To  first  order,  the  sensitivity  operators  tell 
one  how  much  the  system  output  will  be  perturbed  by  small 
changes  in  the  system  parameters.  If  the  sensitivity  is 
high,  then,  in  some  sense,  one  can  more  accurately  estimate 
the  true  parameter  values  (Ref  15:20-32). 
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The  output  error  functional  now  becomes: 


Jj^CAb) 


(A-11) 


It  can  be  shown  using  the  theory  of  least  squares  (Ref 
17:160)  that  the  unique  minimizing  solution  for  the  func- 
tional defined  above  is: 


^bopt.  “ (V*  V)-1(V*  R-1  Z) 


(A-12) 


where  V*  is  the  V adjoint  vector,  (V*  R"^  V)  is  the  (p  x p) 
Gram  matrix  also  called  the  information  matrix  (M) , and 
V*  R~1  Z is  the  p-dimensional  gradient  vector  (H) . 

h - V*  R-1  V R“^[v(i)(t)]  dt  (A-13) 

H - V*  R-1  Z (t)] R“^  Z(t)  dt  (A-14) 

(The  reader  who  lacks  the  background  in  functional  analysis 
should  see  Ref  15) . The  information  matrix  has  general 
Importance  in  estimation  theory  because  the  covariance  of 
the  estimation  error  for  any  unbiased  estimator  is  foxmd 
to  be  limited  by  the  Cramer-Rao  lower  bound  which  is  equal 
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to  the  Inverse  of  M.  This  Is  one  of  the  advantages  of 
maximum  likelihood  estimation.  Another  one  is  the  fact 
that  the  optimal  solution  AbQp^  is  unique  (Ref  8:10-1  to 
10-7) . Since  this  study  deals  with  a non-linear  estimation 
problem,  the  maximum  likelihood  estimation  is  especially 
advantageous  in  that  it  uses  all  the  information  gathered 
between  to  tf  to  generate  the  estimates  about  the 
nominal  path  versus  linearizing  along  the  path  while 
estimating  the  parameters  (as  it  is  done  in  the  Extended 
Kalman  Filter) . 

Thus,  it  is  relatively  easy  to  compute  the  minimizing 
solution  Abopt..  The  updated  parameter  estimate  is  then 
determined  from  the  equation:  ^ 

hi  * bo  + Ahopt.  (A-15) 

The  system  output  may  now  be  linearized  about  bi  and  y(bi) , 
and  the  process  of  obtaining  a new  Abopt.  repeated. 

Because  the  information  matrix  is  of  p x p dimension, 
some  suitable  scalar  measure  must  be  chosen  as  an  optimiza- 
tion criterion.  From  the  information  theory  viewpoint  any 
linear  functional  of  the  dispersion  matrix  (the  inverse  of 
the  Information  matrix)  is  the  most  appropriate  criterion 
(Ref  15:36-38).  As  stated  previously,  the  dispersion  matrix 
is  the  lower  bound  for  the  covariance  matrix  of  the 
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Appendix  B 
Detailed  Derivation 


Derivatives  for  the  Velocity  Sensitivity 

The  sensitivity  states  were  defined  in  Chapter  III. 

As  stated  in  Equation  (41) , the  derivatives  needed  for  the 
integration  of  the  position  sensitivities  are  the  velocity 
sensitivities.  The  algorithm  for  the  evaluation  of  the 
derivatives  for  the  integration  of  the  velocity  sensitivi- 
ties is  given  in  Equation  (43) . 

A 

The  transformation  matrix  (Cj^)  from  the  missile 
inertial  frame  to  the  aircraft  inertial  frame  is  a three- 
by-three  matrix  defined  in  Equation  (7) . Its  derivative 
with  respect  to  the  misalignment  vector  £ defined  in  Equa- 
tion  (3)  is  therefore  a tensor.  Deriving  with  respect 
to  each  of  the  components  of  £ and  multiplying  the  results 
by  the  specific  force  vector  SF; 


1 -ip  e 

Ilf  1 -<P 

-e  (p  1 


(B-l) 


o 

-1 

0 

’-SF2 

- 

1 

0 

0 

SF2 

= 

SFi 

0 

0 

0 

0 

(B-2) 
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SF  = 


3(l> 


SF 


0 

0 

-1 

0 

0 

0 


0 

0 

0 

0 

0 

1 


SFi' 

■ SF3- 

SF2 

0 

SF3 

-SFi 

(B-3) 


SFj^" 

0 ■ 

SF2 

-SF3 

SF2 

(B-4) 


Combining  the  three  columns  of  Equations  (B-2) , (B-3) , and 
(B-4)  to  a matrix: 


3ci 

^.SF 
3e  — 


-SF, 

SFi 


SF3 

0 

-SFi 


0 

-SF3 

SF2 


(B-5) 


This  is  in  fact  the  expression  for  the  derivatives  of  the 
velocity  sensitivities  as  used  in  Equation  (52)  for  Model  1 
The  second  term  of  Equation  (43) , added  in  the  case  of 
Model  2,  involves  the  derivative  of  the  specific  force 
vector  SF  with  respect  to  the  misalignment  vector  £.  The 
specific  force  vector  is  a fxmction  of  the  missile  velocity 
direction  with  respect  to  its  inertial  frame  • 

Tg  (as  stated  in  Equation  (25)): 


r^,  Fg,  and 
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Each  one  of  these  velocity  terms  is  in  turn  a function  of 
the  misalignment  vector  e and  of  the  velocity  components 
in  the  aircraft  inertial  frame  (Equation  (19)): 


Vx  + 'I'Vy  - 0V2 

0Vx  - <|)Vy  + V2 


(B-9) 


The  derivative  of  the  specific  force  vector  with  respect 
to  the  misalignment  vector  c is  then  (as  in  Equation  (45)) 


3SF  _ 3SF  ^ 3V^  ^ ^ ^ 3SF  ^ ^ 
3£  “ 3vM  3vA  3£  gyH  3£ 


3SF  3VM  3^  ^ 3V^ 
3V^  3V^ 


(B-10) 


The  first  term  in  the  brackets  is  a Jacobian  matrix  which 
can  be  expressed  in  terms  of  the  transformation  matrix 
C^.  Using  Equation  (B-9) : 


-0 


(B-11) 


0 ~(p 


I 
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r 


The  second  term  in  the  brackets  is  the  velocity  sensitivity 
( ) defined  in  Equation  (40) . The  third  term  in  the 

brackets  can  be  derived  using  Equation  (B-9) : 


(B-12) 


L 


The  derivative  of  the  specific  force  vector  (SF)  with 
respect  to  involves  differentiation  of  the  direction 
cosine  matrices  and  Fg  with  respect  to  (tensors) . 
Again,  taking  the  derivatives  with  respect  to  each  component 
of  at  a time: 


3SF 

3^ 


3F, 


( ^ Tg  + Fa  ) Fg 


0 

0 

-L 


(B-13) 


Calculating  the  derivatives  of  the  various  entries  of  F^ 
and  Fg  (using  Equations  (B-?)  and  (B-8) : 


(Vi2+V2^)^ 


3Vi 


1 . Vi2  ^ 


(B-14a) 
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<Vl  +V2  > -V1V2 


(B-14b) 


(Vi  +V2  ) 


(Vi>V2  ) _ -V1V2 


(B-14c) 


(Vi  +V2  ) 


V2 

2 2^ 

(Vi>V2  ) 

aV2 


(Vi2+V2^)^  (Vi^+V2^) 


_3_ 

(Vi^+V2^) 


(B-14d) 


(Vi2+v22)% 


(V1SV2  +V3  ) 

3Vi 


Vl 

2^ — 2~; 

V(Vi^+V2  ) 


Vi(Vi2+V22)^ 


VlV^-Vl(Vl^+V2^) 

V^(Vj^^+V2^)^ 


VlV3^ 

v3(Vi2+V2^)^ 


(B-14e) 


(B-14f) 


(B-14g) 


(B-14h) 


(B-14i) 


(B-14j) 


Using  Equations  (B-14)  in  Equation  (B-13)  , the  matrix  1= 
Is  built  as  a Jacobian  matrix  for  the  derivatives  of  the 
specific  force  vector  with  respect  to  the  misalignment 
vector.  Using  Equations  (B-11) , (B-12) , and  (B-13)  in 
Equation  (B-10)  and  then  Equation  (B-15)  and  (B-10)  build 
together  the  total  term  for  the  derivative  of  velocity 
sensitivity  (as  In  Equation  (46)): 


32 

3e 


(B-15) 


Derivation  of  the  Output  Sensitivities 

The  output  (measurement)  vector  consists  of  seven 
components,  the  first  four  of  which  are  radar  measurements, 
and  the  other  three  are  specific  force  measurements.  The 
sensitivity  of  the  specific  force  measurements  to  the  mis- 
alignment angles  vector  £ Is  derived  In  the  previous  section 
of  this  appendix  and  given  In  Equation  (B-10) . The  radar 
measurements  sensitivities  are  stated  In  Equations  (48) 
to  (51)  and  will  be  derived  In  this  section. 

The  four  radar  measurements  are  the  range,  the  range 
rate,  and  the  line  of  sight  azimuth  and  elevation  angles. 
Their  expression  as  a f\inctlon  of  the  position  and  velocity 
states  of  the  missile  In  the  aircraft  Inertial  frame  Is 
given  In  Equations  (20)  to  (23)  (repeated  here  for  com- 
pleteness) : 
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R - (x2  + y2  + z2)% 


(B-16) 


R - + Vz| 


(B-17) 


Sln!|;, 


(B-18) 


Sin6 


R “ E 


(B-19) 


The  position  and  velocity  states  are  functions  of  the  mis- 
alignment vector  thereby  defining  the  sensitivity  states. 
The  radar  measurements,  being  functions  of  the  position 
and  velocity  states  are  therefore  functions  of  the  position 
and  velocity  sensitivity  states.  The  range  sensitivity  Is: 


IS  IS.M  4.  iS.iX  + IS.IZ 
3i(»  * 3X  3i|)  3Y  3i|;  3Z  3i|^ 


(B-20a) 


3R  lSlX.iSlI.3RiZ 
Te  “ 3X*30  W*30  37*30 


(B-20b) 


1 


r 


3R  IR.ax  + + IS.IZ 

3())  " ax  d(^  ^ a<t>  az  a<|) 


(B-20c) 


Using  Equation  (B-16) : 


X 

R 


(B-21a) 


1&  - X 

tY  R 


(B-21b) 


dR 

a? 


z 

R 


(B-21c) 


The  derivatives  of  the  position  states  in  Eqxiatlons  (B-20) 
are  recognized  to  be  the  position  sensitivity  states  — 
(Equation  (39)).  Substituting  Equations  (B-21)  in 
Eqxiations  (B-20)  , results  in  a matrix  form  of  the  range 
sensitivity  with  respect  to  the  misalignment  vector: 


If 


X 

R 


Y 

R 


Z 

R 


ae 


(B-22) 
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r 


The  range  rate  sensitivity  is  derived  in  a similar  manner 
(using  Equation  (B-17)): 


^ 3R  ^ . 3R  ^ . 3R  ^ 

3i(;  * IX  3<J<  3Y  3i(;  ^ 3i(; 

. 3R  ^ 4.  JL  iZX  4.  3R  3Vz  ^ 3R 

3Vjj  3ij)  3Vy  3ij<  3V2  3i|;  3R  dip 


/M  J.  iE  iE  ^1X  , , 3R  . 3R  3R  .3Y 
* 3X  3R  3X  ■'3i|;  ^ 3Y  3R  3Y  ^3i|j 

. , 3R  . 3R  3R  . 3Z  . 3R  3Vx  3R  3Vy  3R  3Vz 

■'■^IX+3R3X>3li7+3^inr'‘’3V^'3^'‘'3^Tir 


1&  . 3R  . 3R  iR  .3X  . , 3R  ^ 3R  3R  .3Y 
30  ” 3X  3R  3X  ‘'39  ^ IX  3R  3Y  ^30 


3R  ^ 3R  3Z  3R  ^ 3R  ^^Y  ^ 3R  . 

+ ^ IX  3R  SX  730  + 3V^  30  + 3Vy  30  + 3V2  30  vB-Z3b) 


^ , 3R  . 3R  3R  n3X  , 3R  ^ 3R  3R  . 3Y 
3^  ' 3X  3R  3X  ^3d)  ' 3 Y 3R  3Y  ^36 


. , 3R  3R  ^ 3R  ^ ^ 3R  ^^Y 

■^'‘3X'''3X  3Z  ■'3(j)  3^  341  3Vy  3<|) 


3R  ^ ^ 

9Vy  34^  ^^2 


R 

I TT 


^asr 


r 


Using  Equation  (B-17)  ; 


dR 


Vx 

R 


3& 


Vy 

IT 


dz 


V 


_z 

R 


3R  _ X 
3Vx  - R 


3R  Y 


- X 


3R 

3^2 


Z 

R 


3R 

3R 


-(XVy  -t-  YVy  + ZV^) 
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(B-24a) 


(B-24b) 


(B-24c) 


(B-24d) 


(B-24e) 


(B-24f) 


(B-24g) 


X 3Vx  Y z 3V2 

R*  3\|;  R*  34)  ■'■  R*  34)  (B-25) 


The  expressions  for  the  derivatives  with  respect  to  6 and 
can  be  derived  in  a similar  way.  In  matrix  form,  the 
range  rate  sensitivity  is; 


IP  + PR  . IV 

3e  ^ 3e 


(B-26) 


where  the  PR  row  vector  is  defined  as: 


(B-27) 
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and  the  VR  row  vector  is  defined  as: 


Vi  (X.Vx  + Y.Vy  + Z.V7) 

Bi  - if ^ ^ ^ • PRi 


where  i - X,  Y,  or  Z. 

The  sensitivity  of  the  sine  of  the  azimuth  angle  is 
calculated  using  Equation  (B-18) : 


(B-28) 


3(Sini|)p^) 


3Y 


XY  3X 


— T ^ ^ X X \ P Jk  wCVl. 

3£  (X^+Y^)^  (X^+Y^)  (?+Y^r^ 


:^7rJr  (-x*  It  + H ) 


(xW) 


(B-29) 


The  sensitivity  of  the  sine  of  the  elevation  angle  is 
calculated  using  Equation  (B-19): 


3(SineR)  1 az  Z , X 3X  . Y 3Y  . Z 3Z  s 

3e  R 3e  “ R be  R 3e  R 3e 


" ^ '--XZ  H - YZ  II  + (X2+  y2)||  ) 
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parameter  estimation  error  (by  the  Cramer-Rao  theorem) , 
therefore  the  trace  of  the  dispersion  matrix  was  chosen 
among  many  other  criteria  as  the  optimization  criterion 
(Ref  14:20).  It  can  be  shown  that  It  Is  directly  related 
to  the  covariance  matrix  of  the  estimation  errors. 


r"-' ^ 

Appendix  C 
Nxmerlcal  Results 

This  appendix  contains  the  results  of  the  computer 
simulations  for  the  Truth  Model,  Model  1 and  Model  2.  The 
titles  of  the  tables  are  appearing  in  the  list  of  tables 
that  is  in  the  prefatory  section  of  this  study. 

EPSITRUE  denotes  the  true  misalignment  angles  while 
EPSIO  denotes  the  nominal  (estimated)  ones  in  the  follow- 
ing order:  d,  <p.  KD  is  the  control  type  used  (defined 

in  Eq.  (26)  to  (31)).  VX,  VY,  and  VZ  are  the  missile 
velocities  relative  to  the  aircraft  and  RD  is  the  range 
rate.  SP.FRC.(  ) denotes  the  specific  forces  measured  by 
the  missile  accelerometers  (not  including  gravity) . DELTA 
denotes  the  difference  between  the  true  output  and  the 
estimated  one.  HOT  is  the  appropriate  higher  order  term. 

The  various  outputs  are  the  range  (R) , the  range  rate  (RD) , 
the  sine  of  the  azimuth  angle  (AZ.),  the  sine  of  the  eleva- 
tion angle  (EL.),  and  the  three  specific  forces  (.SF-^,  SF2, 
and  SF^) . ‘ 


T^UTH 

KO 

MODEL  EOSITRUE*  .lOE+Olf 

= 1 

.2CE^G1,  .30E«01 

TIME 

X 

V 

7 R 

3. 

«130C3E>04 

.-iaC0CE>G4 

.10000E*C3  .14177E»04 

10. 

.21009E+05 

.1479?E»05 

.58759E+04  .26359£»05 

20. 

.40799E+05 

.22326Ef05 

.2174CEf05  .51333E+05 

33. 

.S04SSE4‘05 

.22871E«-C5 

.42fi60E+05  .77471E^05 

(»0. 

.S0929E«-05 

. 15021E+05 

.64F27E+05  .104&5E«-fl6 

50. 

.10321E^06 

-.1370CE<-04 

.82292E-t-05  .132021  + 06 

TI'<E 

vx 

VY 

VZ  RO 

0. 

.20000E4-04 

.1500CE+04 

.10000E+C2  .24694^+34 

13. 

.199S2E404 

.11329E+04 

.11641E+04  .24865E+04 

20. 

.19637E«04 

.3339PE<-03 

.19086E  + 04  .253‘;3£  + fl4 

33. 

.19893E^04 

-.3'J25CE*03 

.22238E+04  .26833E+04 

40. 

,21153E^04 

-•13S2CE+04 

.20592E+04  .2720oE+04 

50. 

.23652E«>04 

-.19441E«>04 

.14747E+04  .279o3E+04 

TIME 

SP.FRC. (1) 

SP.FRC.(2> 

SP.FRC. (3) 

0. 

0. 

0. 

0. 

13. 

-.29ei2F*31 

-.7C695E+02 

.73793E+02 

20. 

-.16753E+01 

-.67123E+02 

.15335E+02 

33. 

.74941E+01 

-.83218E+C2 

-.17808E+0? 

4G. 

.1784lE»02 

-.1C047E^03 

-.ei286E+02 

50. 

.31203E4-02 

-.24964E»Q2 

-.82230E+0? 
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Table  C-II 


Ts.tJTH 

Kf) 

MODEL  EPSI 

s 2 

TRUES  .i0E>01t 

. .20E»01,  .30E»01 

TIM? 

X 

Y 

Z R 

3. 

.icaacE4'C4 

'.lQC0tE4-04 

.lOOCCE+03  .14177E»04 

10. 

.21070E+05 

.ISCOCE^OS 

.534e4E4^C4  .26411E«09 

20. 

.41452E+C5 

.23709E«-05 

.19522E»-05  .51599E  + 05 

30. 

.62239E<-05 

.24192E+05 

.38782E  + 05  .77220E«-05 

40. 

.83467E+09 

.158CtE^05 

.59105E+05  .10349E>a6 

90. 

.10609E«^C6 

.4S947E+02 

.76435E4-09  .13G73E»36 

TIHE 

VY 

VZ  RO 

0. 

.2000GE^04 

.15C0CE^04 

.10000E>C2  .24694E4-04 

10. 

.2fll99E+C4 

.12C6?E*04 

.1028SE4-C4  .2504aE.4-04 

20. 

.20593E+04 

.48624E+03 

.17396E+04  .25354E*-b4 

30. 

.20357E+04 

-.40033E+03 

.20465e»04  .25923E*04 

43.  . 

.21S32E+04 

-.lEESgE^O** 

. 19486E+04  .26659E^04 

Ml 

O 

• 

.23935E+04 

-.1816EEf04 

.14632E»04  .27965E+04 

TIME 

SP.FRC. (1) 

SP.PRC.C2) 

SP.PRC.(3) 

0. 

0. 

0. 

0. 

10. 

.30921E^01 

-.5!-040E+02 

/ 

.58495E+02 

20. 

.41041E4-01 

-.83974E+C2 

.13745E+02 

30.. 

.35S88E4-01 

'-.9C4eiE+32 

-.•21131E*02 

40. 

.12322E+02 

-.7e589E402 

-.62604E^02 

90. 

.35425E+02 

-.29925E*02 

-.94291E+02 
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Table  C-m 


T?UTH 

K1 

* ^ • 

MOOEL  Et»SlTRUE=  .lOE+01, 

s 3 

.20E4-Clt  .30E4-01 

4 

THE 

X 

Y 

7 R 

d. 

.10000E«>04 

• 10GCCE^0<* 

.lCOOOE+03  .14177E+04 

10. 

.21035E+05 

.14763E+05 

.53624E«-04  .26359E<-05 

20. 

.409T0E+05 

. 22153E+05 

.21fi0iE  + 05  ,51341E«-05 

?0. 

.60876E+C5 

.22527E+0E 

.42279E+05  .7746oE+05 

40. 

.814&6E*05 

.145C9E+05 

.63968E+C5  .10459E+05 

*S0. 

.103S0E+0O 

-.26497E^04 

•.  81422E  + C5  .13180E<-06 

time 

yx 

VY 

V2  RO 

0. 

.23000E+34 

.15C0CE+04 

.10G00E*02  .24694E+04 

10. 

.20040E«-04 

.11240E+C4 

.11590E+fl4  .24863E+04 

23. 

.19S35E+04 

.36684E+03 

.13890E+04  .25359E»04 

30. 

.20112E4>04 

-.3195FE*03 

.21960E+04  .26862E*04 

40. 

.21132E*C4 

-.132CEE+04 

.20339E+04  .27105E+04 

SO. 

.23340E4-G4 

-.1981CE+C4 

.14562E+C4  .27742E4-04 

TIME 

SP.FRC.  (1) 

SP.FRC. (2) 

fP.FRC..  (3) 

0. 

0. 

0. 

0* 

10. 

-.14840E4^01 

-.72056E+02 

.72497E+02 

' 20. 

-.91557E+00 

-.67357E+02 

.1415CE+02 

30. 

.59971E+01 

-.83C43E<-02 

-.18263E*02 

40. 

.i4444E+02 

-.lC143Ef03 

-.83341E+02 

50. 

.28717E+32 

-.27130E+02 

-.32203E«-02 

J 


Table  C-IV 


THITH 

<0 

MODEL  EOSITRUE=  .50Ef31, 

* 1 

.10E*C2,  .15E4-02 

TIME 

X 

Y 

7 

R 

0. 

.13009E4>94 

.IOOOCE^Oh 

.10CC0E»03 

14177E+04 

19. 

.21045E*C5 

.1474SE*05 • 

.58^21E4-C4 

26359E+95 

• 

o 

CM 

.40945E^05 

.22151E+05 

.2irj41E+05 

51337E4-05 

39. 

.6073fiE+03 

> .2255CE+05 

.4^7g^£♦05 

77464E+05 

40. 

.81414E4-0? 

.14591E+C5 

• 64C9S£«^C5 

10464E+95 

?0. 

.10399E+S6 

-.22g6CE+04 

. 81779E+C5 

13193E+06 

TIME 

vx 

VY 

vz 

RO 

0. 

.20900E1-04 

.1500CE+04 

.ia000E4-02 

24694E«-04 

10. 

.20039E«-04 

.11233E+04 

.11599E+04 

24864E+04 

20. 

.19772E»04 

.3693eE^03 

.18959£*C4 

25355E+04 

30. 

.20063E4-04 

-.31683E+03 

.220262^04 

2e875E4>04 

40. 

.21353E+04 

-.13082E«-04 

.2C260E»04 

27193E>a4 

50. 

.23S32E»C4 

-.19372E+04 

.14343E^04 

27939E+04 

time 

SP.FRC. (1) 

SP.FRC.  (2) 

SP.FRC. (3) 

0. 

0. 

0.. 

0* 

10. 

-.29834E+01 

-.7C660E+02 

.73813E^02 

20. 

-.16644E+01 

-.67095E4-02 

.15334E«^02 

30.  . 

.75636E+01 

-.P3124E»02 

-.17786E»0C 

40. 

.18195E*32 

-.1C030E^03 

-.81084E4-02 

5*0. 

.3132BP+02 

-.24892E^02 

-. 819592^02 

■ 

Tab 


-V 


I 


T*^UTM 

KO 

MOOEL  EPSITRUE=  .50E*01f 

= 2 

.10E4>02|  .15Et02 

TIME 

X 

Y 

7 R 

d. 

.1C09CE+C4 

;i0GGCE^04 

.1CC00E4-03  .14177E4-04 

10. 

.21102E+C5 

.14959E*05 

.53365E+04  .26411E+05 

23. 

.41576E+C? 

.23557E+05 

.19433E+05  .51537E+05 

33. 

.62504E+05 

.23921E+05 

.38516E  + C5  .77217E«-05 

40. 

.33908E»0’5 

.15442E+05 

.58554E  + 05  .10343E4'06 

50. 

.10S68E>06 

-.3037eEf03 

.75516E+05  .1307aE*06 

TIME 

vx 

VY 

VZ  RO 

9. 

.20000E+04 

. 1500CEt04 

. 1000CE<^02  .24694E4-04 

10. 

.20253E+04 

.11981E+04 

.10253E+04  .25039E*04 

20. 

.20711E+04 

.4738fE*03 

.17272E+04  .25353E+04 

30. 

.21129E+04 

-.4117EE+03 

.20232E+04  .25919E+04 

40. 

.21317E»04 

-.12609E+C4 

.19153E’i’04  .26643E4^04 

50. 

.24100E+04 

-.18101E+04 

.14237E+04  .27933E+04 

1 

TIME 

SP.FRC.  (1) 

SP.FRC. (2) 

SP.FRC. (3) 

0. 

0. 

0. 

0* 

13. 

.30130E+31 

-.55023E+02 

.53510E+02 

20. 

.41097E+31 

-.fi394CE*02 

.18744E»02 

30. 

.37576Ef01 

-.9C367E^02 

-.21107E+02 

40. 

.12577E+02 

-.7e454E+02 

-.62451E«-02 

50. 

.35567E+02 

-.29829E»02 

-.93974E+02 

I 
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Table  C-VI 


t^uth 

•CO 

MODEL  EPSITRUEs  .50E+01, 

* 3 

.10E«-02»  .15E«02 

TIMF 

Y 

Z 

R 

0. 

.10030E4-04 

4l0G0CE«04 

.10000E«03 

.14177E»04 

10. 

.21072Ef05 

.147lfE+05 

.5848SE^C4 

.26359E+05 

20. 

.4lll4E+05 

.21991E»05 

.21499E+C5 

.51339E+35 

30. 

.61l73E+e5 

.22211E+05 

.420C5E4'05 

.77459E»^05 

40. 

.81948E^(!5 

.14089E+05 

.6342CE^0P 

.104531^06 

SO, 

.10428E+C5 

-.30644E'f04 

.8Q496E405 

.13177E+06 

TIIP 

VX 

VY 

V2 

RO 

0. 

• 20000E4>04 

.1500CE+04 

.1CCCGE^C2 

.24694E4-04 

10. 

.20116E404 

.11144E+04 

.11F47E+04 

.24869EV-04 

20. 

.19359E>C4 

.75251E+03 

.18759E+04 

.25357E+04 

30. 

.2028CE^C4 

-.333pPE+03 

.2l745E<-04 

.26853E4-04 

43. 

.21380E»04 

-.13265E+04 

.20004E4-04 

.2709SE»04 

50, 

.23519E+04 

-.19742E+04 

.14157E+04 • 

.2772Q£+fl4 

TIME 

SP.fRC. (1) 

SP.FRC. (2) 

SP.FRC. (3) 

3. 

0. 

0. 

0. 

10. 

-.15895E+01 

-.72025E4-02 

.72516E^02 

20. 

-.9054CE*3C 

-.67327E^02 

.14148E4-02 

30. 

.71625E+01 

-.e2948E+02 

-.18239E»02 

40. 

• 14798E4-02 

-.1C127E+03 

-.80139E*02 

50. 

.29852E>32 

-.27065E+02 

-.81929E^02 
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Table  C-VII 


HOOSL 

M/0  rnis 

<0  a 

1 EOSITRUE*  . 10000E<-01, 

E «:P3I0s  G.  f 

1 ITERATION  * 1 

.2030QE4'01> 

C.  , 0 

.3>j030E4>01 

• 

TIHP 

DELTA  HCT(R) 

OELTA(RO) 

9DT(R0) 

0. 

3.  0. 

C. 

0. 

10. 

-.21727E+Q0  .47242E-02 

.13745E-01 

.15314E-32 

?0. 

.23252E+30  .4C669E-ai 

.22372E-C1 

.55933E-32 

SC. 

-.89958E+0C'  .11544E*-00 

-.29050E<-C0 

.91527E-02 

40. 

-.S'iSSAE^Ol  .22561E+00 

-.9G775E«-C0 

.l2361E-fll 

9C. 

-.20584E4>02  .3t655E4-00 

-.19573E»C1 

.14390E-Q1 

TIME 

9ELTA(A7.)  HOT(AZ.) 

DELTACEL.) 

MOT(EL.) 

0.  ' 

0.  0. 

0. 

0. 

10. 

-.49855E-03  -.91641E-07 

-.13390E-C3 

-.41379E-07 

20. 

-.11CC2E-Q2  -.91514E-37 

-.49673E-C3 

-.33525E-35 

30. 

-.15414E-C2  .5e090E-06 

-.87024E-C3 

-.33182E-06 

40. 

-.16266E-02  .17165E-05 

-.12712E-02 

-.14130E-05 

50. 

-.11654E-02  .18531E-fl5 

-.16982E-C2 

-.19992E-05 

time 

TRADE  OP  ESTIMATE 

DISPERSION  ERROR  IN 

MATRIX  PSI 

ESTIMATE 
ERROR  IN 

TETA 

estimate 

ERRDR  IN 

PMI 

3. 

0.  0. 

0. 

0. 

13. 

.19173E-01  -.61E-02 

.29E-02 

.33E-02 

2C. 

.2C145E-03  -•60E-02 

.46E-02 

.54E-32 

33. 

.10151E-C4  -.74E-02 

.lOE-02 

.39E-03 

40. 

.22812E-05  -.lOE-01 

-.45E-02 

-.30E-92 

50. 

1 

.79537E-06  -.13E-01 

-.77E-02 

-.13E-01 
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Table  C-VIII 


MQO''L  1 EOSITRIJE*  .lOCOOt  + 01,  .230CCF*01,  .13C33E  + 01 

M'O  M-JISE  EPSIOs  .lOl’cE^-Ol,  .20Q77E  + 01,  .30n3£  + 01 

KD  s I ITERATIOM  • 2 


TIME 

OELTA(^) 

HPT (R> 

OELTA(RO) 

MDT(RO) 

0. 

0.  3 

• 

0. 

3. 

1«. 

-.31249E-02 

^lCl&5E-3& 

-.16594E-02 

.33441E-07 

20. 

-.42S14E-01 

.99755E- OS 

-.60065E-02 

.14913E-05 

30. 

-.11S78E>00 

.3C605E-05 

-.389a5E-C2 

.25507E-35 

43. 

-.22705E+QU 

.6t333E-05 

-.13278E-01 

.41073E-06 

SO. 

-.37025E*00 

.11080E-04 

-.14242E-C1 

.49353E-05 

TIME 

0ELTA(A7.) 

HOT(A2.) 

OELTA(EL.) 

HDTCEL.) 

0. 

0.  O 

• 

0. 

0. 

1C. 

.22555E-05 

.1S887E-11 

.627i6E>06 

-.73450E-12 

20. 

.53845E-0S 

. 24696E-11 

.25467E-C5 

-.D1098E-11 

30. 

.7SS40E-PS 

.28273E-10 

.47184E-05 

-.14535E-13 

40. 

.79392E-05 

.677  80E-10 

.71383E-05 

-.22459E-13 

SO. 

.48881E-0? 

.62121E-10 

.96757E-C5 

-.251&7E-13 

TIME 

TRACE  OF 

OISPERSION 
MATRIX 

ESTIMATE 
EPROR  IN 
PSI 

ESTIMATE 
ERROR  IN 

TETA 

ESTIMATE 

ERRDR  IN 

PHI 

0. 

c* 

0. 

0. 

0. 

10. 

.19226E-01 

-.14E-06 

.12E-06 

.14E-06 

20. 

.20249E-C3 

-.13E-06 

.24E-06 

.33E-36 

33. 

.10149E-04 

■“  .16E-06 

.14E-06 

.152-06 

40. 

.22333E-C5 

-.24E-06 

-.76E-08 

-.73E-07 

SO. 

.78q01E-06 

-.33E-C6 

-.13E-06 

-.27E-06 
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• Table  C-IX 


M/o  *nis 

K1  s 

1 Fer;iToUE  = 

E EP^IOs 

1 ITERATION 

. locoaE^oi* 
.10C0CE4-01, 

« 3 

.20a0CE+01, 

.233C0E4-01y 

.30C03E+C1 

.3000CE4-01 

TIME 

3ELTA(R) 

HCT  (R) 

OFLTACRD) 

MDT (RO) 

C. 

3.  3 

• 

0. 

0. 

13. 

-.♦3772E-CT 

.73318E-09 

-.36700E-C7 

-.33907E-1D 

?0. 

-.10373E-05 

.3‘‘340E-08 

-.15812E-06 

-.31572E-ID 

30. 

-.3C8C3E-05 

.21420E-C9 

-.25550E-C6 

.37757E-12 

49. 

-.63917E-03 

.43431P-i38 

-.41509E-C6 

.30501E-10 

50. 

-.11109E-04 

.22151E-09 

-.49743E-C6 

.'41935E-10 

TIME 

0£LTA(AT, ) 

HOT(AZ.) 

OELTA(EL.) 

M9T(EL.) 

0. 

0.  0 

• 

0. 

0. 

10. 

.46353E-10 

.11043E-13 

.12792E-10 

-.15886E-13 

?0. 

.11359E-09 

.2C2iOE-14 

.54120E-10 

.22724E-13 

38. 

.16412E-C9 

.77041E-14 

.102&2E-C9 

.2S360E-13 

40. 

.16930E-09 

.81212E-14 

.15786E-C9 

.37498E-13 

50. 

.99042E-13 

.19391E-14 

.21627E-C9 

.ia709E-12 

TIME 

TRACE  OP 

DISPERSION 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
ERRO’?  IN 
TETA 

estimate 

ERROR  IN 

OMI 

0. 

0. 

0. 

0* 

0. 

10. 

.19226E-C1 

-.39E-0e 

-.24E-07 

-.321-37 

30. 

.20248E-C3 

.22E-08 

.13E-08 

.25E-fl8 

39. 

.10149E-04 

.29E-08 

.68E-08 

.97E-08 

40. 

.22534E-05 

-.34E-09 

.llE-08 

.92E-09 

50. 

.78C38E>0e 

-.39E-08 

-.43E-08 

-.’3E-38 
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Table  C-X 


MOOPL 

1 E^SITRUE*  .10.:oo^+Gl, 

.2:000E*Ol, 

.3JC2CE+31 

W/0  Nil'S 
Kn  - 

;£  EPSio=  f 

2 iTE?aTion  # 1 

S J 

0.  , 0 

• 

TTHF 

^ELTa(®)  HCT(R) 

OELTACRO) 

^^T(RD) 

1 

0. 

0.  0. 

C. 

0. 

IG. 

-.13S?6E+00  .3r291E-i)2 

.13443E-01 

.11186E-02 

20, 

.36519E+0a  .29425E-01 

.S4566E-C1 

.«»3267E-02 

30. 

-.27S41E-01  .93326E-01 

-.21265E+00 

.35241E-G2 

<»G. 

-.53251E*ai  .19907E«-03 

-.aiSOHEf-OO 

.12463E-01 

50. 

-.19469E+C2  .33679E+00 

-.19537E<-C1 

.14683E-01 

TIME 

0ELT4<AZ.)  HOT(AZ.) 

OELTA{EL.) 

HDTCEL.) 

0. 

0.  0. 

0. 

0. 

10. 

-.41S30E-03  -.69415E-07 

-.11555E-03 

-.27901E-U7 

20. 

-.39S31E-03  -.8«!265E-C7 

-.44092E-C3 

-.21298E-05 

30. 

-.1272SE-02  .4G859E-06 

-.37415E-03 

“•33829E-03 

40. 

-.13331E-02  .12603E-05 

-.13224E-02 

-.11583F-05 

50. 

-.96937E-03  .17461E-05 

-.17254E-C2 

-.17370E-03 

TIME 

TRA3E  OP  ESTIMATE 

9ISPERSI0N  ERROR  IN 

MATRIX  PSI 

ESTIMATE 
ERROR  IN 

TETA 

estimate 

ERROR  IN 

PHI 

2. 

0.  0. 

0. 

0. 

10. 

.22840E-01  -.52E-02 

.41E-03 

.18E-03 

20. 

.29435E-03  -.51E-02 

.17E-02 

.13E-02 

30. 

.13S49E-04  -.51E-02 

.18E-02 

.20E-02 

40. 

.15595P-05  -.54E-02 

.llE-02 

.35E-03 

53. 

.34542E-06  -.63E-02 

-.23E-03 

-.13E-02 

Table  C-XI 


MOnFL 

W/0  NDIS 
<■)  s 

1 FPSIToUEs  .ICCOOE+Oli 

£ £3^10=  .1C063E+C1, 

2 ITERATION  » 2 

.2C0C0E«-C1, 

.2:002E«-01, 

.33033E»01 
. 30313*«-01 

i 

TIHF 

DELTA(R)  HCT(R) 

OELTA(RO) 

M3T(RD) 

0. 

3.  0. 

0. 

0. 

10. 

-.303V4E-C2  -.2r930E-09 

-.10945E-P2 

.39513E-09 

20. 

-.29440E-01  .12632E-ii7 

-.%4324E-C2 

.32366E-03 

30. 

-.9402sE-Cl  .82397E-07 

-.8511SE-02 

. 10  o95E*  D 7 

40. 

-.199C1E+00  .24134E-06 

-.12411E-01 

.21504E-37 

50. 

-.33385E+D0  .5C511E-C6 

-.15279E-C1 

.31102E-3^ 

TIME 

DELTA  (AZ.)  H0T(A2.) 

DELTA(EL.) 

H3T(EL.) 

0. 

0.  0. 

0. 

0. 

10. 

.235E5E-C6  .43249E-14 

.72055E-C7 

.13599E-13 

20. 

.S6339E-C6  .3E916E-12 

.39895E-06 

.9a333E-t3 

30. 

.1C30CP-05  .17135E-11 

.97712E-06 

.34397E-12 

40. 

.94474E-06  .30438E-11 

.16639E-05 

• .ld456E-ll 

60. 

.14610E-C6  .64500E-12 

.22697E-05 

.35964E-11 

TIMr 

TRACE  OF  ESTIMATE 

DISPERSION  ERROR  IN 

MATRIX  PSI 

ESTIMATE 
ERROP  IN 
TETA 

ESTIMATE 

ERROR  IN 

PHI 

3. 

0.  0. 

3. 

0. 

10. 

.22319E-01  .llE-08 

.33E-07 

.42E-07 

20. 

.29460E-03  -,l7E-i}d 

.94E-08 

.llE-07 

30. 

.13667E-C4  .ldE-G8 

.22E-07 

.29E-07 

43, 

.15698E-05  -.lOE-08 

.17E-07 

.2l*-07 

50. 

.34h51E-C6  -.39E-08 

.12E-a7 

.13E-07 
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Table  C-XII 


HOn^L  1 :P3ITOiJF  = 

W/0  ‘niSE  "'>■310= 

KH  = 2 ITE'>ATIOM 

. 100CCE4-01, 

. 1000CE4-G1, 

A 3 

.20900E*01, 

.2CJ00E4-01f 

.3o:ooe4-oi 

.3J030E+01 

TIME 

DELTfl(R) 

HCT(R) 

DELTA (RO) 

HDT(RD) 

0. 

0.  0 

• 

0. 

0. 

10. 

.128C6E-C8 

.7O567E-09 

.38208E-10 

.31798E-10 

20. 

-.14S58E-07 

.17249E-08 

-.36525E-08 

.53096E-10 

:30. 

-.31956E-07 

.21654E-09 

-.10937E-C7 

-.17479E-11 

40. 

-.24533E-C5 

.4C366E-08 

-.21202E-C7 

-.159C4E-39 

50. 

-.51259E-06 

.3t40aE-08 

-.32539E-07 

-.22751E-09 

TIHE 

OELTA(ftZ. ) 

HOT (A2.) 

OELTA(EL.) 

H3T(EL.) 

0. 

C.  0 

• 

0. 

0. 

10. 

-.20073E-11 

.43612E-13 

-.53380E-12 

.15014E-13 

1 

20. 

-.39S59E-11 

. 29124E-13 

-.18812E-11 

.13056E-13 

30. 

-.534S6E-11 

.17301E-13 

-.34319E-11 

-.32372E-14 

40. 

".53524E*11  - 

.2E529E-14 

-.47713E-11 

.29046E-13 

50. 

-.47230E-11 

.14897E-14 

".59579E-11 

.24030E-13 

TIME 

T9a:e  op 

OISPE'^SION 

MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
ERROR  IN 
TFTA 

ESTIMATE 

ERROR  IS 

PHI 

0. 

C. 

0. 

0. 

0. 

10. 

.22ai9E-01 

-.44E-08 

-.13E-07 

-.19E-07 

20. 

.29460E-03 

-.2CE-08 

-.63E-08 

-.92E-08 

30. 

.IISSTE-Ci* 

-.16E-08 

-.92E-09 

-.23E-08 

40. 

.15698E-05 

-.29E-08 

-.44E-08 

-.72E-0B 

so. 

.344SiE-0f 

-.46E-09 

-.77E-39 

-.13E-08 

Table  C-XIII 


MOOrL 

H/0  Mils 
ifl  s 

1 EOSI"?UE=  .lOaCUE^Ol, 

E EeSIO=  C.  f 

3 ITERATION  « 1 

.2G300E»01, 

C.  , 0 

.30003E^01 

• 

timF 

DELTA  (R)  HCT(R) 

OELTA(RO) 

HOT(RO) 

c • 

0.  0. 

0. 

0. 

10. 

-.18236E+G0  .47165E-02 

.22909E-C1 

.13774E-32 

20. 

.39521E+03  .4t710E-01 

.345S1E-01 

. 56555E“0  2 

30. 

-.3o708E+30  .115C0E+00 

-.28875F+00 

.91448E-02 

40. 

-.53v26E+01  .22554E+30 

-.91954E+C0 

.12983E-31 

50. 

-.2C590£^02  .3e892E«-3G 

-.19834E+C1 

.15246E-01 

TIMF 

OELTACAT.)  HO'TtAZ.) 

OELTACEL.) 

HDT(EL.) 

C. 

0.  0. 

0. 

0. 

10. 

-.48749E-03  -.89437E-07 

-.13985E-C3 

-.407g0E-37 

?a. 

-.1C893E-C2  -.7C838E-07 

-.51474E-C3 

-.33012E-35 

30. 

-.15124E-02  .5e753E-06 

-.d9545E-03 

-.91916E-05 

40. 

-.15924E-02  .lf87aE-05 

-.12934E-02 

~ . 1 4 0 0 JE“3  5 

so. 

-.112C2E-C2  .17772E-05 

-.17257E-C2 

-.20027E-C5 

TIMF 

TRADE  OP  ESTIMATE 

DISPERSION  ERROR  IN 

MATRIX  PSI 

ESTIMATE 
ERROR  IN 

TETA 

ESTIMATE 

ERRDR  IN 

PHI 

0. 

0.  0. 

0. 

0. 

10. 

.18554E-01  -.58E-C2 

.30E-C2 

.3'4E-02 

?0. 

.18322E-03  -.57E-02 

.H8E-02 

.571-02 

30. 

.94236E-05  -.65E-02 

.15E-02 

.llE-02 

40. 

.20997F-05  -.97E-02 

-.35E-02 

-.55E-02 

50. 

.74909E-06  -.12E-01 

-.65E-a2 

-.12E-01 
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Table  C-XIV 


HOOPl  1 EP‘;iTRi)P=  .IGCCGE^Ol,  . 200  C Cl*  01,  .3300Dl*01 

M/«  ‘niSE  EPSIOs  .lCli9£*jl,  .23J66E*01,  .33117E+01 

K1  = 3 ITERATION  » Z 


TIME 

DELTA  ('») 

HOT(R) 

DELTA(RO) 

MDKRO) 

0. 

0. 

0.. 

d. 

0. 

10. 

-.31406E-C2 

.7C963E-C7 

-.16467E-02 

.27554E-07 

23. 

-.42351E-01 

.7£453E-06 

-.59682F-C2 

.11790E-OS 

?C. 

-.11526E*09 

.21-243E-C5 

-.de813E-C2 

.21199E-35 

<»«). 

-.22571E+CC 

.515G5E-05 

-.13351E-01 

.33335E-0D 

53. 

-.37253E+30 

.9C039E-05 

-.14772E-01 

.41940E-0& 

TIHF 

0ELTA(ft7.) 

HOTCAZ.) 

0ELTA(EL.) 

HDT(EL.) 

0. 

0. 

G. 

0. 

10. 

.19S53E-C5 

-.120  61E-11 

.57736E-C6 

-.59541E-12 

20. 

.47295E-05 

.2e485E-ll 

.23480E-C5 

-.432‘*4E-11 

30. 

.55594E-C5 

.2375CE-10 

.43403E-C5 

-.10513E-10 

40. 

.68155E-03 

.5ii083E-10 

.65408E*05 

-.15327E-10 

50. 

.404&1E-05 

.4735CE-10 

.38444E-C5 

-.17175E-13 

TIME 

tpa:e  of 

DISPERSION 

MATRIX 

ESTIMATE 
ERROR  IN 

PS  I 

ESTIMATE 
ERROR  IN 
TETA 

ESTIMATE 

ERROR  IN 

PHI 

0. 

C. 

0. 

0. 

0. 

13. 

.18608E-01 

-.95E-07 

.12E-06 

.14E-06 

20. 

.18928E-03 

-.87E-07 

.22E-36 

.27E-96 

33. 

.94222E-05 

-.12E-06 

.13F-C6 

.141-1)6 

40. 

.20T8hE-05 

-.17E-06 

.27E-07 

-.93E-08 

• 

o 

IT 

.7?S42E-0fi 

-.24E-C6 

-.S3E-37 

-.15E-06 
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Table  C-XV 


MOOEL 
M/0  M3 
K1  s 

1 EOSIT9UES 

ISt  ro<5TO  = 

3 ITERATION 

.lOCOOEfOly 

.1C300E4-01, 

» 2 

.2oaacE+oi, 

.2Oa00E4-01) 

.33:03E*01 

.33aC0E*01 

TIMP 

D£LTA(R> 

HCT(R) 

OELTA(RO) 

H3T(RO) 

0. 

3.  0 

• 

C. 

0. 

10. 

-.3d90».F-07 

.1C544E-09 

-.28551E-C7 

.4>.124E-13 

?G. 

-.3w9C9E-06 

.13266E-0a 

-.12392E-C6 

.33914E-G9 

35. 

-.  2'*3S3E-  05 

. 12814E-J8 

-.20488E-C6 

.?3381E-a9 

hG  . 

-.51l5eE-05 

.6C826E-06 

-.33835E-C6 

.41337E-09 

50. 

-.9C273E-C5 

.12452E-07 

-.42238E-C6 

.a0292E-C9 

TIME 

0ELTA(A7.) 

HO'^CAZ.) 

OELTA(EL.) 

M3T(EL.) 

Q. 

0.  0 

• 

0. 

0. 

10. 

.2R517E-10 

.17717E-13 

.77121E-11 

-.45795E-15 

20. 

.65V54E-1Q 

.82516E-13 

.33623E-10 

-.71113E-14 

30. 

.95a49E-10 

.88069E-13 

.54653E-10 

-.233245-13 

1.0. 

.96907E-13 

.108SuE-l2 

.1C010E-C9 

-.91736E-14 

50. 

.51357E-1C 

.9C513E-13 

.13749E-09 

-.19463E-13 

TIME 

TRACE  OF 

0I5=ERSI0N 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
ERROR  IN 
TETA 

ESTIMATE 

ERR3R  IN 

PMI 

5. 

0. 

0. 

0. 

0. 

10. 

.1SS08E-01 

.195-39 

-.llE-07 

-.13E-07 

23. 

.13927E-03 

.soE-ca 

.16E-07 

.23E-07 

30. 

.94221E-0P 

-.22E-08 

-.35E-08 

-.35E-08 

I»0. 

.20734E-05 

.52E-09 

.14E-36 

.?3E-08 

50. 

.r3547E-06 

-.55E-09 

-.llE-39 

-.53E-09 
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MOHEL 
with  ‘IOIS 
KT  = 

1 EPSTTR'JEs 

E EPSIO= 

1 ITEPATION 

.lCOGOE+01, 

j . f 

» 1 

.2J08CET01,  .3a]00E*Cl 

0 . y 0 . 

time 

nELTA(P) 

HCT(R) 

OELTA(RO)  ^^T(RD) 

0. 

.11254E*02 

.11254F.T02 

.9209dE^Cl  .92093£^31 

10. 

.15725E+b^ 

.l€9‘t7E402 

.ia698E«-02  .10S46E4-32 

20. 

.T3351E*01. 

.71435E»01 

-.11823E«-C2  -.11839E+a2 

3C. 

-.13156£»C2 

.12151ET02 

-.11909E«'C2  -.11610E+32 

40. 

-.21416E+02 

.lt655ETC2 

.97332E»-01  .10554ETC2 

50. 

-.39639E+02 

.lfc689E*C2 

-.13562E«-C2  -.11599E+02 

time 

nELTA(AZ.) 

HOT(AZ.) 

OELTA(EL.)  HDT{EL.) 

0. 

-.15531E-02 

.15561E-02 

.90217E-03  .90217E-03 

10. 

.88414E-03 

.13727E-02 

.59303E-C3  .72338E-C3 

20. 

-.88023E-03 

.21986e-03 

-.17939E-02  -.12975E-02 

30. 

-.17573E-02 

.22535E-03 

-.49941E-C3  .3399dE-33 

40. 

-.87758E-03 

.7E277£-a3 

-.d33S7E-G3  .43585E-C3 

50. 

-.120a7E-02 

.3S436E-04 

-.13656E-02  .33065E-33 

TIME 

T??A:F  O'* 

dispersion 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE  ESTIMATE 

ERROR  IN  ERRDR  IN 

TETA  PMI 

0. 

0. 

0. 

0.  0. 

10. 

.2C948E-C2 

-.80E+fll 

.13E+01  -.73E*00 

2G. 

.30248E-04 

.74E+J0 

-.41E»aO  -.13E+30 

30. 

.33748E-05 

-.2fiE-01 

-.55E-02  -.2a£-01 

49. 

.64403E-06 

.21E-01 

-.29E-01  -.23E-01 

50. 

.2037CE-a6 

-.16E-01 

-.20E-01  -.45E-01 

Ill 


HOOEL 

MITH  Nils 
KO  * 

1 5PSIT«?UE= 

E E»SIO= 

1 ITt5>aTI0M 

.1C  OuuE^Jlt 
.lUl62E4>Jly 

♦ 2 

.2:3CCE>31, 

,2C2C2F*Clf 

.333J3E+01 

.30^351*01 

TIMF 

DELTA(R) 

HCT(R) 

OELTACRO) 

H3T(RO) 

C. 

.11?54E^C2 

.11254£fC2 

.92093E4-C1 

.92598E+31 

1C. 

.15^r7P+C2 

.ie942E*Q2 

.1P651E»02 

.10S44E+a2 

20. 

.^2141E«-31 

.71026E»01 

-.11836E«-C2 

-.11945E+32 

30. 

-.12C!.8E  + C2 

.122&6E«’02 

-.116C6E4-C2 

-.11519E4'32 

40. 

-.14517E*02 

.l^-8aiE<-02 

.lC658e*02 

.1054iE+02 

50. 

-.19432E+C2 

.1c035E»02 

-.11531E+02 

-.ilD05E+02 

TIHP 

3*LT4(A7. ) 

H0T(A7.) 

OELTACEL.) 

M3T(EL.) 

0. 

-.15551E-02 

.15561E-32 

.9C217E-03 

.93217E-33 

IS. 

.13795E-02 

.13728E-02 

.72868E-03 

.72592E-03 

20. 

.23534E-03 

.21995E-03 

-.12905E-C2 

-.12972E-02 

30. 

-.2C385E-03 

.22591E-03 

.382S3E>03 

.37081E-03 

40. 

.77498E-03 

.7E106E-03 

.*♦54995-03 

.!»3726E-03 

50. 

-.23606E-04 

.41238E-04 

.35706E-C3 

.33265E-03 

TIHt 

T?A3E  OF 

OISPF^SION 
HRTPIX 

ESTIMATE 
ERROR  IN 
PSI 

estimate 

ERROR  IN 
TETA 

ESTIMATE 

EPR3?  IN 

OMI 

3. 

0. 

0. 

0. 

0. 

13. 

.20933E-02 

-.8CE+0J. 

.13E+01 

-.79EI.00 

23. 

.30204E-04 

.75E+30 

-.41Ef00 

-.lDE«-00 

33. 

.33589E-05 

-.19E-01 

-.70E-02 

-.22E-01 

40. 

.S4304E-06 

.27E-01 

-.30E-01 

-.25E-01 

50. 

.20349E-06 

-.llE-01 

-.21E-01 

-.47E-01 

MOn’^L 
WITH  »nr 

O s 

1 E»SIT^ijE  = 

SE  FP.5I0= 

1 ITERATION 

.100u0E4-01« 
.lOllOEfOl, 
n 3 

.2SOOO-+01, 

.2C2C8E*01f 

.3a303E*01 
.33475E  + 01 

TI*iP 

r»£LTA(0) 

HCT(R) 

OELTA(RO) 

MDT(RO) 

0. 

.11254E+02 

. 11264Ef 02 

.92098E*C1 

.92098E4-fll 

10. 

.16935E*C2 

.If 942E+32 

.1C653E4^C2 

. 19344E*u2 

20. 

.TESIOE^CI 

.7l026£4>0i 

-.11830E»02 

-.llS45EfiJ2 

30. 

-.11930E<-0? 

.12266E4-02 

-.11597E+02 

-.11519E+32 

40. 

-.14289E>C2 

.1^88lE«-02 

.lfl671E^C2 

.13941E402 

•50. 

-.18107E+02 

..19C55E+02 

-.11554E*02 

-.11&05E+02 

TIME 

0ELTA(AZ.) 

HOT(A2.) 

OELTA(EL.) 

MDT(EL.) 

0. 

-.15551E-02 

.1‘’561E-C2 

.90217E-C3 

.30217E-03 

10. 

.13795E-02 

.13728E-02 

.72870E-03 

.72S92E-03 

20. 

.23549E-03 

.21995E-03 

-.12906E-02 

-.12972E-02 

30. 

-.203S8e-03 

.22591E-C3 

.38237E-C3 

.37381E-33 

40. 

.77539E-03 

.7MC6E-G3 

.45450E-C3 

.43726E-03 

50. 

-.22652E-0‘» 

.41236E-04 

.35640E-03 

.3I265E-03 

TIME 

tra:e  of 

DISPE^ESION 

MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
ERROR  IN 
TETA 

ESTIMATE 

ERRDR  IN 

PHI 

9. 

0. 

0. 

0* 

0. 

10. 

.20933E-02 

-.80E+01 

.13E+01 

-.73E«>00 

23. 

.30236E>a4 

.75E+0C 

-.41E«-00 

-.13E4^90 

30. 

.33589E-05 

-.19E-01 

-.70E-02 

-.22E-01 

43. 

.64304E-0e 

.27E-01 

-.3CE-01 

-.25E-01 

50. 

.20349E-0ft 

-.llE-01 

-.21E-01 

-.47E-01 
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• Table  C-XIX 


“OOPL 

WI'H  *JTIS 
KT  s 

1 EOSITR'IE  = 

E F5SIO= 

2 iteration 

.<ccccE*ai, 

G.  , 0 

9 1 

.2300CE4>01> 

. f 0 

.33C03E»01 

• 

TTMC 

lELTA(R) 

MCT 

OELTA(RO) 

MDT{RO) 

C. 

.11254E+0? 

. 11254E+02 

.92093E+C1 

.92D98E*31 

10. 

.16754E+02 

.1€9h7£*32 

.10653E4>C2 

.IJS^SE+OE 

?0. 

.7U707E^01 

.71351E«-21 

-.11780E«-C2 

-.11341E+02 

30. 

-.1?201E*02 

. 12160£*C2 

-.11830E+C2 

-.11509E+02 

40. 

-.20l85EfG2 

.146&()E*G2 

.972&6E«-C1 

.10654E+32 

F3. 

-.38495E*Q? 

.1S689E+02 

-.13557EfrC2 

-.11589E+32 

time 

OELTA(AZ.) 

HOT(AZ.) 

OELTA(EL.) 

H3T(EL.) 

0. 

-.155olE-fl2 

.lE5ftlE-02 

.90217E-C3 

.90217E-33 

1C. 

.35423E-33 

.13723E-a2 

, .51123E-C3 

.72584E-03 

20. 

-.67617E-03 

/ 

.220C6E-03 

-.17333E-02 

-.12976E-02 

30. 

-.149S5E-02 

.2?5?9E-a3 

-.50363E-C3 

.3399CE-03 

40. 

-.58558E-C3 

.7E25aE-03 

-.S8541E-03 

.43577E-03 

50. 

-.1C108E-02 

.30829E-Ct 

-.13940E-02 

.33a57E-a3 

TIME 

TRASE  OF 

0ISFER5I0N 
MATRIX 

ESTIMATE 
ERROR  IN 

PSI 

ESTIMATE 
ERROR  IN 

TETA 

ESTIMATE 

ERROR  IN 

PMI 

0. 

0. 

0. 

0. 

0. 

in. 

.27r>l7E-0? 

-.96E*01 

.15E+01 

-.iaE«-oi 

20. 

.33434E-04 

.71E+J0 

-.hOE+OO 

-.34E-01 

30. 

.29604E-05 

-.37E-01 

-.16E-02 

-.27E-01 

40. 

.54323E-U6 

.14E-C1 

-.26E-01 

-.25E-01 

50. 

.24356E-06 

-.19E-01 

-.20E-01 

-.51E-01 
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Table  C-XX 


MOOFL 

WITH  'nis 
KO  s 

1 So^ITP'IFs 

£ EOSIO= 

3 ITERATION 

.ICGGOE^Olt 

.1C1S9£«-C1, 

# 2 

.2CaC0E+01, 

.2C2C4E4C1, 

.33000E+01 

.30512£*01 

TTMF 

DELTA(T) 

HOT (R) 

OELTACRO) 

MDT(RO) 

. 1135‘»E+  i2 

.11254C+52 

.92C93E+C1 

.92098F^D1 

1C. 

.16934r4.02 

.1C943E+02 

.10652E4-02 

.13349E*32 

30. 

.73375E+01 

.71057E*01 

-.11836E4-02 

-.11845E+02 

30. 

-.13039E+02 

.12253E+02 

-.11635E»r2 

-.11317E+02 

V3. 

-.14493E+03 

.li-859E*02 

.10659E+C2 

.10S42E+02 

50. 

-.15433E+CI2 

.19026E+02 

-.115S0E+C2 

-.1150  4E+0  2 

TIMF 

DiLTA(AZ.) 

H0T<A2.) 

OELTACEL.) 

RDT(EL.) 

0. 

-.155S1E-C2 

.15561E-02 

.90217E-03 

.90217E-03 

10. 

.13791E-C2 

.13728E-02 

.72852E-03 

.72589E-03 

30. 

.33397E-03 

.22015E-03 

-.13909E-02 

-.12974E-02 

33. 

-.205’46E-:3  - 

.‘2257CE-Q3 

.38377E-C3 

.37050E-03 

40. 

.77333E-03 

.7F124E-03 

.45768E-03 

.43694E-03 

50. 

-.34728E-G4 

.41175E-04 

.36023E-03 

.33234E-33 

TIMS 

TRACE  OP- 

DISPERSION 
MATRIX 

ESTIMATE 
ERROR  IN 

PS  I 

ESTIMATE 
ERROR  IN 
TETA 

ESTIMATE 

ERROR  IN 

PHI 

0. 

0. 

0. 

0. 

0. 

10. 

.27603E-02 

-.96E+01 

.15E+01 

-.13E+01 

30. 

.33401E-04 

.72E+00 

-.40E+00 

-.34E-31 

30. 

.29566E-05 

-.32E-01 

-.26E-02 

-.29E-01 

40. 

.54744E-06 

.20E-01 

-.37E-01 

-.23E-01 

50. 

.34338E-06 

-.14E-01 

-.23E-01 

-.53E-01 
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Table  C-XXI 


MOn«^L 

‘4013 
<0  = 

1 EPSITRMFs 

E EP3I0= 

2 ITERATION 

. ICCOCE^Glf 
.10137E+01, 

« 3 

. 2030064-01, 
.2o215E401, 

.330336401 

.335236401 

TTMT 

OELTA (») 

HCT  (9) 

On.TA(RD» 

-IDT(RD) 

0. 

.112F4E«-0? 

.11254E+02 

.92098E4-01 

.920986401 

13. 

.16903C+C2 

.16943E+02 

.1065364^02 

.133456432 

?C. 

.72558E+01 

.71C57E+C1 

-.11831E4-C2 

-.118456432 

33. 

-.11932E+0? 

.12253E*02 

-.11597E4-C2 

-.116176402 

40. 

-.142S7e+o2 

.14d59E*02 

.106726402 

.135426402 

fiO. 

-.1810  2E-t-02 

.1EC26E+02 

-.1156^E4C2 

-.1150  4£4D  2 

TIMF 

OELTACAT.) 

HOT(AZ.) 

DELTACEL.) 

HDT(EL.) 

0. 

-.15551E-02 

.1S561E-02 

.902176-03 

.9C217E-33 

10. 

.13792E-02 

.lc728E-02 

.728546-03 

.72566E-03 

20. 

.234C5E-i:3 

..22C15E-03 

-.129106-02 

-.129746-02 

30. 

-.20542E-03 

.22570E-03 

.38352E-C3 

.370506-33 

40. 

.77341E-C3 

.7E124E-03 

.457146-03 

.43594E-03 

50 . 

-.24053E-C4 

.41175E-Q4 

.359456-03 

.332346-03 

THE 

TRA3E  or 

DISPERSION 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
ERROR  IN 
TETA 

ESTIMATE 

ERRDR  IN 

PHI 

3. 

0. 

0. 

0. 

0. 

10. 

.27603E-02 

-.96E+01 

.156401 

-.106401 

20. 

.33>»31E*C4 

.72E+Ja 

-.•4CE400 

-.946-31 

33. 

.29566F-05 

-.326-01 

-.266-02 

-.236-01 

40. 

.64744E-C6 

.206-01 

-.276-01 

-.256-31 

52. 

.24328E-C6 

-.146-91 

-.226-31 

-.53E-01 
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MI’M  *JJIS 
KT  a 

1 EOSIT^HEa 

E EPSIOa 

3 ITEPariON 

.lOOCOE^Olt 

0.  , 

# 1 

.20330E4-C1, 

0.  y 1 

.3000024-01 

D. 

TIMF 

0ELT4(R) 

HCT(Rl 

DELTAfRO) 

HDKRO) 

3 • 

.11254E+02 

.11254E+02 

.92C93E*C1 

.92099Ef31 

IS. 

.l6''59FfQ2 

.If 947E+U2 

.106&7E+02 

.ia346Et32 

2C. 

.74943E+01 

.71446E+01 

-.11810E+02 

-.11339E4-02 

30. 

-.12929E+0? 

.12i47E  + 02 

-.119C7E+C2 

-.11509E+a2 

UC, 

-.21228E«-C2 

.146E0E<-a2 

.97215E+01 

.13554E4-C2 

50. 

-.39637F+C2 

.lS67dE+02 

-.1358dE*02 

-.115a9£*02 

TIME 

OELTaCflZ.) 

HOKAZ.) 

OELTAfEL.) 

HDT(EL.» 

0. 

-.15561E-C2 

.15561E-02 

.?fl21^E-a3 

.90217E-C3 

13. 

.39530E-b3 

.13727E-02 

.5e7a7E-03 

.72i87E-03 

23. 

-.8e990E-03 

.21986E«03 

-.18119E-02 

-.12975E-02 

30. 

-.17383E-02 

.2P533E-03 

-.52467E-03 

.3a994E-03 

40. 

-.83132E-03 

.75276E-03 

-.8eil7E-03 

.43590E-tJ3 

50. 

-.11515E-C2 

.3S484E-04 

-.13931E-02 

.330582-03 

TIME 

tr4:e  of 
3IS»ERSION 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
ERROR  IN 
TETA 

ESTIMATE 

ERR3?  IN 

PMI 

0. 

0. 

0. 

0. 

0. 

10. 

.19437E-C2 

-.77E+01 

.12€*01 

-.92E4-00 

23. 

.28S17E-04 

.70E>1C 

-.4CE+00 

-.93E-01 

33. 

.32713E-05 

-.28E-01 

-.4CE-02 

-.202-01 

40. 

.64304E>0e 

.20E-01 

-.29E-ai 

-.22E-01 

53. 

.20636E-06 

-.16E-01 

-.20E-ai 

-.!»5E-31 

Table 


III 


C-XX 


HOO'L 
with  ‘OIS 
Kl  » 

1 tPSITP’JEs 

£ £e'>10= 

3 IT£!?ATI0N 

.ICCCuE^uly 

.10164E+J1, 

« 2 

.2:J0CE+31, 

.2G198F4-01, 

.3:C33E+31 
. 30  ♦55£4  0 1 

TTHF 

3£LTA(R) 

HCKR) 

OELTA(RO) 

^DT(R0) 

G • 

.11254£*'02 

.11254E4:2 

.92099E«-01 

.92098E4-C1 

IS. 

.16978F+C2 

.ie942E+C2 

.106r.lE+C2 

.13dU5E432 

20. 

.72148£+01 

.71039E+01 

-.11836E402 

-.11345E+02 

30. 

-.12047E*C2 

. 12262E402 

-.11606E«-C2 

-.11318E402 

40. 

-.14517P+C2 

.1'‘875E402 

.10658E+C2 

.10541E+C2 

50. 

-.19493E4-02 

.19047E+02 

-.11531E+C2 

-.11504E+02 

timf 

D£LTA(AZ.  ) 

HOT(AZ.) 

OELTA(EL.) 

HDKEL.) 

0. 

-.1555ie-02 

.15561E-02 

.90217E-03 

.90217E-C3 

1C. 

.13794E-G2 

.137  28E-02 

.72875E-G3 

.72991E-03 

20. 

.23513C-03 

.21993E-03 

-.12903E-C2 

-.12972E-32 

30. 

-.20425E-C3 

.22591E-D3 

.3829&E-G3 

.37076E-C3 

40. 

.77437E-03 

.75107E-03 

.45537E-03 

.43720E-33 

50. 

-.24213E-04 

.41261E-04 

.35749E-03 

.33258E-03 

TIMr 

tra:e  OF 

DISPERSION 

HATPIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
ERROR  IN 
TETA 

ESTIMATE 

ERROR  IN 

PRI 

0. 

0. 

0. 

0. 

0. 

10. 

.19424E-02 

-.77E401 

.12E+01 

-.32£*fl0 

20. 

.28*!79E-04 

.71E+J0 

-.40E400 

-.91E-01 

30. 

.32655F-05 

-.21£-ei 

-.55E-02 

-.22E-01 

40. 

.S4205E-06 

.26E-01 

-.30E-01 

-.24E-01 

50. 

.20&13E-06 

-.llE-01 

-.21E-01 

-.47E-01 

^ jjrrrrr. 
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Table  C-XXIV 


•nOFL  1 -=»SITRIJE  = 

MI7M  MDISc  £0510= 

<0=3  ITPRATIOM 

. ]00CGE4-C1» 
.1C112E+01, 

* 3 

.20300E4-01, 

.2C206E+-01, 

.30000E+01 

.30474E4.01 

time 

DELTA  (0) 

HOT (R) 

DELTA  (RO) 

H3T(R0) 

c • 

.1125hE+C2 

.11254E+02 

.92093E4-G1 

.92a95E*fll 

10. 

.16935E+02 

.16942E^02 

.10653E^C2 

.13345E+C2 

2Q. 

.72611E*C1 

.71039E+01 

-.11831E»02 

-.11845E+02 

30. 

-.11929E+C2 

.122f»2Ef02 

-.11597E+02 

-.11518E+32 

2»0. 

-.1«.235E+D2 

.1<-875E+C2 

.10671E+02 

.lGo41E^32 

90. 

-.181C6E<-C2 

.19047E+32 

-.11563E+C2 

-.11504E4-02 

time 

0ELTA(A7.  ) 

HO-^tAZ.) 

DELTA(EL.) 

HOKEL.) 

0. 

-.155&1E-C2 

.15561E-02 

.90217E-03 

.90217E-03 

10. 

.13796E-G2 

.13728E-02 

.72877E-C3 

.73591E-03 

2C  . 

.23332E-03 

.21993E-C3 

-.129C4E-C2 

-.12972E-02 

30. 

-.2C40SE-03 

.22591E-03 

.38263E-C3 

.37076E-33 

40. 

.77477E-03 

.751C7E-03 

.45486E-C3 

.43720E-03 

50. 

-.23272E-0‘‘ 

.H1261E-04 

.35679E-03 

.33258E-03 

time 

TRADE  OF 

OIS=*EOSTOM 
MATRIX 

ESTIMATE 
EPPOR  IN 
PSI 

ESTIMATE 
ERROR  IN 
TETA 

ESTIMATE 

ERRDR  IN 

PMI 

0. 

0. 

0. 

0. 

0. 

13. 

.1942<‘E-02 

-.77E4-01 

.12E+01 

-.82E+00 

33. 

.28579E-04 

.71E+30 

-.40E«'00 

-.91F-01 

30. 

.32558E-05 

-.21E-iJl 

-.55E-02 

-.22E-01 

%0. 

.54205E-06 

.26E-01 

-.3CE-31 

-.24E-01 

50. 

.2C%13E*06 

-.llE-01 

-.21E-01 

-.47E-01 
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MO^fL 

mitm  'nis 
<1  = 

1 

E Eo^IO= 

1 ITE^ATIOM 

ifocaoE+oi, 

c • » 

# 1 

.lC30C^«-02, 

0.  » a 

. 15003E«-02 

1. 

TIMc- 

3ELTA(R) 

HCT{R) 

OELTA(RO) 

MOT (RO) 

P. 

.11254*4'0? 

• 11 2 E4E+  G 2 

.92093E+C1 

.92393E+31 

IP. 

.159U2E+02 

.17060E+O2 

.10743E*-C2 

.10584E+32 

23. 

.90326E+31 

.81247E4-01 

-.11625E+02 

-.11703^+02 

?0. 

•.14“54E*C2  - 

.97838E+01 

-.12893E+02 

-.11791E+02 

40. 

-.43072E+02 

.92667E+G1 

.93809E+01 

.ia9';9E*D2 

50. 

-.11424E+03 

.99699E+01 

-.21023E+C2 

-.11238E+32 

TIMF 

OELTA(A7.) 

HOT(A2.) 

OELTA(EL.) 

M0T(EL.) 

0. 

-.15561E-02 

.1F561E-02 

.9C217E-03 

.932175-03 

13. 

-.lQrE3E-:2 

.177  05E-02 

.58126E-C4 

.72585E-03 

20.” 

-.52845E-C2 

.21776E-03 

-.37812E-C2 

-.13056E-02 

33. 

-.79239£-02 

.21174E-03 

-.398i6E-C2 

.35009E-03 

40. 

-.33;96E-02 

.79374E-33 

-.59154E-02 

.40232E-03 

SO, 

-.58505E-02 

.46457E-05 

-.81490E-02 

.23355E-03 

TI'1^ 

T«IACE  OF 

. OIS^E^STON 
MATRIX 

ESTIMATE 
ES!RCR  IN 
PSI 

ESTIMATE 
ERROR  IN 

TETA 

estimate 

ERROR  IN 

PHI  • 

0. 

C. 

0. 

0. 

0. 

13. 

.21016E-02 

-.81E+01 

.l3Ef01 

-.73E4-00 

20. 

.3041FE-04 

.59E+3C 

-.39E+30 

-.37E-C1 

33. 

.3393CE-q5 

-.19£*30 

.30E-01 

.llE-01 

43. 

.S4744E-06 

-.12E+30 

.17E-92 • 

.23E-01 

50. 

.20429E-06 

-.i3E*ao 

-.6CE-02 

.95E-03 

Table  C-XXVI 


•IITH  *J^IS 
<1  - 

1 -PSITniJEs 

E EPSIO= 

1 ITERATION 

' .'^COOCE  + 01, 
.^1343E+01, 

Ip  Z 

.1C3CCE+02, 

.19306E+02* 

.1500CE*02 

.1.919E+02 

TIM? 

3£LTA(R) 

HPT  (R> 

DELTA  (RO) 

M3T  (RO) 

• 

J • 

.1123*.E+C2 

.11254E+32 

.92C93E+01 

.92098E+01 

1C. 

.167^3£+?2 

.ie942E«-G2 

.1C6C1E«-C2 

.10545E+02 

?c. 

.51130E+C1 

.71031E+01 

-.11953E+C2 

-.11345E+02 

33  . 

-..14gl5E*C2 

.12266E+02 

-.11811E+C2 

-.11519E+02 

•tO, 

-.19956E+02 

. l<-881E+02 

.10343E*C2 

.10641E+02 

53. 

-.2744.9E+C2  - 

.19C56E>u2 

-.119’5E+C2 

-.11S05E+-C2 

TIME 

OELTAU?.  ) 

HOT  CAZ.) 

DELTA(EL.) 

MDT(EL.) 

0. 

-.15561E-C2  - - 

.lE5eiE-02 

.9C217E-03 

.90217E-03 

10. 

.13751E-02 

.13723E-02 

.72809E-03 

.72‘56  7E-0  3 

20. 

.23150E-03 

.239g8E-03 

-.12893E-02 

-.12972E-02 

30. 

-.20874E-03 

.22584E-03 

.388‘»0E-03 

.37373E-03 

uo. 

.76447E-03 

.7F116E-C3 

.‘♦6584E-C3 

.43719E-03 

50. 

-.45133E-04 

.‘•1148E-04 

.3712.4E-03 

.33253E-03 

71M- 

TRACE  0^ 

OISOERSION 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
ERROR  IN 
TETA 

ESTIMATE 

ERROR  IN 

OMI 

C. 

0. 

0. 

0. 

0. 

10.. 

.20945E-0? 

' -.79E*ai 

.12E+01 

-.73E4-00 

20. 

.3023gE-04 

.75E+00 

-.41E+0C 

-.lOE+00 

33. 

.33595E-05 

-.19E-01 

-.72E-02 

-.22E-01 

43. 

.64254E-06 

.27E-01 

-.31E-01 

-.25E-01 

50. 

.20330E-06 

-.lOE-01 

-.21E-01 

-.45E-01 

J 
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Table  C-XXVII 


moo*:l 

WITH  NDIS 
KD  = 

1 poSITTU^s 

E FP<>IOs 

1 IT-'^A’TON 

.'GCCOE^Ol, 

,t0102E+Cl, 

3 

.nocct^oE, 

.1C021E4-02, 

.1R030E4-02 

.l53!»3E*a2 

TIMF 

DzLT4(R) 

HCT(R) 

delta  (RO) 

HDT(RO) 

0. 

.11254-4-02 

.11254E*02 

.92G98E4-C1 

.92398E+01 

1 

1C. 

.16935E4-02 

.lt942E*02 

.1G653E*C2 

.10645F+02 

20. 

.72S11E+C1 

.71031E+01 

-.11831E+02 

-.11345E+02 

70. 

-.11970E+02  - 

.12266E+02 

-.11597E+C2 

-.il519Ef02 

40. 

-.14283E+02 

.lf881E+02 

.10671E+02 

.10&41E+02 

SO. 

-.18i05E+C2' 

.19C56E4-32 

-.11553E+02 

-.11505F+02 

time 

OELTAIA-^.) 

HOT(A2.) 

OELTACEL.) 

MOKEL.) 

-0. 

-.155S1E-02'  - 

.155.61E-02 

.9C217E-C3 

.90217F-03 

10. 

.13797E-C2 

.13728E-02 

.72866E-03 

.72s87E-C3 

20. 

.23555E-C3 

.21998E-03 

-.129Q7E-C2 

-.12972E-02 

70. 

-.20365E-C3 

.22584E-03 

.38271E-03 

.37073E-0.3 

4Q-. 

.77534t-fl3 

.7F116E-03 

.45443E-03 

.43719E-C3 

. so. 

-.22S93E-C4 

.41147E-04 

.35631E-03 

. .33258E-03 

TIME 

TRACE  OF 

0I<;PER9I0N 
MATRIX 

ESTIMATE 
ERROR  IN 
PS  I 

ESTIMATE 
ERROR  IN 
TFTA 

ESTIMATE 

ERROR  IN 

PMI 

0. 

0. 

0. 

0. 

0. 

1C. 

.20944E-02 

-.79E+01 

.12E+01 

-.79E*-00 

20. 

.30209F-04 

.75E+30 

-,41E+'00 

t.ioe+oo 

31. 

.33694E-05 

-.192- 31 

-.72E-02 

-.22E-01 

49. 

.D4262E-06 

.27E-ai 

-.31E-01 

-.25E-01 

S3. 

.20329E-06 

-.lOE-01 . 

-.21E-C1 

-.48E-01 
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Table  C-XXVIII 


MOnpL  1 EoSITRUEs 

WITH  MTISE  EoriOs 

•CO  s 2 ITERATION 

.EOGOOE^Olt 
C.  t 
« i 

.1000054-02, 

0.  y 1 

.1500054-02 

3* 

TIME 

DELTA <R) 

HOT (R) 

OELTA(RO) 

M3T(RO) 

0. 

.11254E+C2 

.11254E+02 

.92C93E+C1 

.923985-431 

1C. 

.16054E4-C2 

.17032E*02 

.10733EVC2 

.1057354-02 

20. 

.94A38E4-31 

.7e417E+Cl 

-.11440E4-C2 

-.11737E+02 

39. 

-.10611E+02 

.99235E+31 

-.12514E»02 

114055*02 

40. 

-.37524E+D2 

.99074E+01 

.&3355E4-01 

.1095054-02 

50. 

-.10927E+03 

.1C674E+02 

-.21021E+02 

-.1124254-02 

TIME 

0ELTA(A7. ) 

HOT{AZ.) 

OElTA(EL.) 

HOTtEL.) 

0 

0. 

-.15561F.-02  - - 

.13561E-02 

.90217E-C3 

.90217E-D3 

: 10. 

-.72155E-03 

.13711E-02 

.14921E.-03 

.725125-03 

20. 

-.42644E-Ca 

.2181CE-C3 

-.35018E-02 

-.130285-02 

30. 

-.65827E-02 

.21539E-03 

-.39969E-02 

.355355-03 

. 40. 

-.59140E-02 

.7e260E-03 

-.61695E-02 

.408065-03 

50. 

-.48733E-02 

. 775 38 E- 05 

-.82909E-02 

.298935-03 

TIME 

TRACE  OF 

OlS^ERSrO'N 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
ERROR  IN 
TETA 

ESTIMATE 

ERRDR  IN 

PHI 

0. 

0. 

0. 

0. 

0. 

10. 

.27690E-02 

-.98E+01 

.15E*01 

-.1054-01 

23. 

.335fi9E-04 

.59E4-00 

-.39E4-00 

-.895-01 

30. 

.29757F-05 

-.17E»30 

.21E-01 

-.57E-02 

40. 

.65367E*C6 

-.llEfOO 

.44E-32 

.79E-02. 

50. 

.24424E-06 

-.14E»30 

.52E-02 

-.215-01 

Table  C-XXIX 


HOn^L  1 FPSITRUEs 

MI’H  ‘niSE  EP5IO= 

K1  - 2 iteration 

.f C0flC£*01, 
.ri402E*01f 

# ? 

.1C0C0E*C2, 

.99948EV01, 

.i;333E^02 

.1S021E+02 

TIMF 

3ELTft(R) 

HCT(R) 

OELTA(RD) 

^^T(RD) 

0. 

.11254E<>02 

.11254E^02 

.92093E»01 

.92098E+01 

10. 

.16S33E4^C2 

.K'943E+02 

.10623E*-C2 

.13&45E4-02 

?0. 

.64906F+01 

.7lfl62E>01 

-■.11941E+02 

-.11345E+02 

30. 

-.14238F+C2 

.12252E<>02 

-.11806E+02 

-.11617E+02 

40. 

-.l9253‘+02 

.14860E+02 

•103S0E^02 

.10542E+02 

SO. 

-.25620E+02 

.1S027E+02 

-.11956E+02 

-.11304E+U2 

TIME 

OELTA(AI,) 

HOT(AZ.) 

OELTA(EL.) 

MOT(EL.) 

0. 

-.155S1E-C2 

.15561E-02 

.9e217E-a3 

.30217E-03 

10. 

.13757E-C2 

.l?729E-fl2 

.72800E-03 

.72582E-03 

20. 

.23194E-03 

.22017E-03 

-.12901E-02 

-.12975E-02 

30. 

-.206S1F-03 

.22563E-03 

.38925E-03 

.37043E-03 

40. 

.76S09E-03 

.75134E-03 

.46953E-03 

.43S86E-03 

50. 

-.40653E-G4 

.41041E-04 

.37738E-03 

.33227E-D3 

TIME 

TRACE  OF 

DISPERSION 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
ERROR  IN 
TETA 

ESTIMATE 

ERROR  IN 

PHI 

3. 

0. 

0. 

0. 

0. 

10. 

.27620E-02 

-.96E+01 

.15E+01 

-.lOE^Ol 

20. 

.33407E-04 

( .72E+30 

-.40E+00 

-.95E-01 

30. 

% 

.29575E-05 

-.32E-01 

-.2gE-fl2 

-.2SE-i)l 

40. 

.64691E-C6 

.20E-01 

-.27E-01 

-.2sE-01 

53. 

.2429CE-06 

-.13E-01 

-.22E-01 

-.5‘3E-01 
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MonfL 

WITH  ‘HIS 
KT  = 

1 EOSITRUE* 

E EPSIOs 

2 ITCPATION 

.50  COuE^O 1» 
.5012dE+01f 

i 3 

.1GG0CE>02» 

.10a22E4-02» 

.15000E  + 02 
.15053£*02 

TIME 

DELTA (R) 

HCT(R) 

OELTACRO) 

MDT(RO)  . 

0. 

.llE^AE+OE 

.11254E+02 

.92C98E+P1 

.92398E+31 

io.« 

.15987E«-02 

'.If  943E+C2 

.10653E+C2 

.13545E+02 

20. 

.72585E+01 

.71062E^C1 

-.11831E%02 

-.11845E*02 

30. 

-.11932E»02 

.12252E+02 

-.11597E+C2 

-.llS17E<-02 

40. 

-.14288E>02 

.l(f860E>02 

.10672E+02 

.13542E+02 

SO. 

-.161Q1E+C2 

.lEOETF^OE 

-.11563E+02 

-.11504E+02 

TIME 

DELTA(A7.) 

HOT(AZ.) 

OELTACEL.) 

MDT(EL.) 

0. 

-.15561E-C2 

.15561E-02 

.90217E-C3 

.90217E-23 

10. 

.13793E-02 

.13729E-02 

.72850E-C3 

.72682E-03 

20. 

.23413E-03 

.22017E-03 

-.12910E-02 

-.12975E-02 

30. 

-.2053SE-03 

.22563E-03 

.3834&E-03 

.37042E-03 

40.! 

.77339E-03 

.75134E-03 

■.•♦5706E-03 

.43686E>03 

50. 

-.23980E-04 

.41041E-04 

.35936E-03 

.33226E--03 

time 

TRACE  OF 

ni9PER5I0N 
MATRIX 

ESTIMATE 
EPROR  IN 
PSI 

ESTIMATE 
ERROR  IN 
TETA 

ESTIMATE 

ERROR  IN 

PHI 

0. 

0. 

0. 

0. 

0. 

10. 

.27620E-C2 

-.96E+01 

.15E+01 

-.10.E»01. 

20. 

.33407E-04 

.72E+00 

-.40E*00 

-.95E-01 

30. 

.29574E-05 

-.32E-01 

-.29E-02 

-.23E-01 

40. 

.64689E-C6 

.2aE-01 

-.27E-fll 

-.2SE-01 

50. 

.24269E>06 

-.13E-01 

-.22E-01 

-.5'3E-01 
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with  MOIS 
KO  s 

1 f'»‘;tt'?ue= 

E EPSIOs 

3 ITERATION 

.C003CE+01, 

G.  f 

« 1 

.100nCE*02, 

0.  » 0 

.1933994-02 

• 

TIMP 

DELTA (R> 

HOT  (R) 

OELTA(RO) 

HDT(RO) 

c • 

.11254E+C2 

. 112f4E«-C2 

.92G98E4‘C1 

.92a98E4^31 

10. 

.1511‘.E*C2 

.17060E«u2 

.10739E+C2 

.10984E4-02 

?p. 

.98173P+U1 

.6122CE^01 

-.11555Ef02 

-.11703E4-02 

3C  . 

-.1339ae+02 

.97911E+01 

-.128S1E*C2 

-.11391E432 

40. 

-.4215'iE+02 

.92632E«-01 

.S7241E+01 

.10962E4-G2 

(;o. 

-.11422E4-C3 

.99016E«-01 

-.21152E*C2 

-.11229E+32 

TIME 

OELTA(AZ.) 

H0T(A2.) 

OELTA(EL.) 

MDT(EL.) 

0. 

-.15551E-a2 

.15561E-02  . 

.90217E-C3 

.90217E-D3 

10. 

-.1C665E-C2 

.13706E-02 

.28347E-04 

.725359-07 

.20. 

-.52325E-C2 

.21825E-03 

-.38711E-02 

-.13055E-02 

30. 

-.77789E-02 

.21109E-03 

-.41cr3E-02 

.350369-33 

40. 

-.71298E-02 

.79303E-03 

-.60514E-C2 

.402609-03 

*;o. 

-.56261E-02 

.26135E-a5 

-.32859E-02 

.23340E-03 

time 

TRADE  OF 

OISPER'^ION 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
ERROR  IN 

TETA 

ESTIMATE 

ERRDR  IN 

P*<I 

3. 

0. 

0. 

0. 

0. 

10. 

.19h99E-02 

-.73E+01 

.17E+01 

-.32E4-90 

29. 

.28774E-04 

.55E4>00 

-.38E»00 

-.7SE-91 

30. 

.32934E-05 

-.i9E+ao 

.32E-01 

.98E-02 

40. 

.64627E-06 

-.12E»0C 

.37E-a2 

.229-01 

90. 

. .20692E-06 

-.14E+0C 

-.31E-02 

-.139-02 

•Table  C-XXXII 


MO0'‘L 

WITH  NOIS 

K1  ~ 

t EOSITOUE* 

5 -3310= 

3 ITERATION 

.CQCOCEf-Oly 
.ri3&7E*01f 
» 2 

.10000E4-(}2y 

.10103E«-02i 

,lSZiOE*Q2 

.1'5()02E*02 

TIMF 

3ELTA{R) 

HOT<R) 

OELTA(RO) 

RDT(RO) 

0. 

.11254E+C2 

.11254E+J2 

.92C93E*D1 

.92398E«3i 

1C. 

.168ulE*02 

.1C942E*C2 

.10602E4-C2 

.10545E+02 

?C. 

.61233E+01 

.7304i*E*01 

-.11969E»02 

-.11345E+02 

39. 

-.140Q5E«-02 

.12262E+02 

-.11811E«-C2 

-.11318E+j2 

tiO. 

-.193B1F4-G2 

.148  75E<-02 

.10340E<-02 

.10B41E+D2 

5fi. 

-.275C0E*02 

.190hSE4^02 

-.1193^E■^C2 

-.11304E+02 

TIME 

0ELTA(A7.) 

HOT(AZ.) 

OELTA(EL.) 

H3T(EL.) 

0. 

-.155S1E-C2 

.1F561E-02 

.90217E-C3 

.30217E-33 

.13762E-C2 

.12728E-02 

.72814E-C3 

.72o87E-C3 

2C. 

.23156^-03 

.21994E-03 

-.12890E-02 

-.12973F-02 

30. 

-.20871E-03 

.22564E-03 

.38895E-C3 

.37069E-03 

40. 

.76433E-03 

.7B118E-03 

.46672E-03 

.43713E-C3 

<;o. 

-.45429E-04 

.41122E-0U 

.372&2E-C3 

.33251E-C3 

Tl'lr 

TRACE  OF 

0ISPER3I0N 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
ERROR  IN 
TETA 

ESTIMATE 

ERROR  IN 

PHI 

0. 

0. 

0. 

0. 

0. 

10. 

.19435F-02 

-.77E*01 

.12E»01 

-.92E+00 

20. 

.28587E>04 

.71E«-0iJ 

-.40E4-00 

-.91E-01 

30. 

.32S66E-05 

-.21E-01 

-.58E-32 

-.22F-01 

40. 

.54149E-06 

.27E-01 

-.30E-01 

-.24E-01 

50. 

.2C5S4F-06 

-.lOE-01 

-.21E-01 

-.‘♦3E-01 
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WITH  WTIS 
KO 

1 E^SITP'JE* 

i iP3I0= 

3 ITERATION 

.^CCCGFVOI, 

.^0134E4>«)1» 

* 7 

.i:0C2E»02, 

.lQ321E*02f 

.13003E«>02 

.l5j:»3E>02 

TI»*P 

DELTA(P) 

HOT(R) 

DELTA  (RO) 

HDT(RO) 

0. 

.11254E«-02 

.112&4E^02 

.92093E+C1 

.9239SE*31 

10. 

.16935E+C2 

■.169<*2E*02 

.10653E«-C2 

.10545F«.02 

ao. 

.72S11E«-C1 

.71044E4-01 

-.lie31E«-C2 

-.11845E+02 

3C. 

-.1193CE*02 

.12262E+G2 

-.11597E»C2 

-.11518E+32 

40. 

-.14289E4-02 

.1487SE+02 

.1C671E+C2 

.ia341FfD2 

SO. 

-.18105E+02 

.19C48E+02 

-.11563£«-C2 

-.11304E+32 

TIME 

OELTACAZ.) 

HOT(A2.) 

DELTA(EL.) 

HOT  (EL.) 

0. 

-.15551E-02 

.1F561E-02 

.90217E-C3 

.3D217E-33 

10. 

.13796E-02 

.13728E-02 

.72873E-C3 

.72387E-C3 

23. 

.23538E-C3 

.21996E-03 

-.12904E-C2 

-.12973E-J2 

30. 

-.204C5E-03 

.22564E-03 

.38262E-C3 

.37066E-03 

40. 

.77472E-C3 

.75118E-03 

.45478E-03 

.43713E-03 

SO. 

-.23203E-04 

.41121E-04 

.35669E-C3 

.33251E-U3 

TIMi 

tra:e  of 

DISPERSION 

WATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
ERROR  IN 
TETA 

ESTIMATE 

ERROR  IN 

PHI 

0. 

0. 

0. 

0. 

0. 

10. 

.19435E-02 

-.77E*-01 

.12E4-01 

-.32E+00 

20. 

.28S87E-04 

.7lE+flO 

-.40E«-00 

-.91E-01 

30. 

.3266SE-0S 

-.21E-01 

-.58E-32 

-.22E-01 

40. 

.54148E-06 

.27E-01 

-.3CE-01 

-.24E-01 

SO. 

.20S33E-C6 

-.lCE-01 

-.21E-01 

-.•iSE-Ol 
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Table  C- 


ji 


MOOFL 

M/0  *nis 

fO  s 

2 roSIToUE= 

E EP'^IOs 

1 ITEPftTTOM 

.:ccc:e+ci, 

0 . t 

» 1 

.2u3i3CE401,  . 

G . f C . 

302335401 

TTV- 

OELTA (») 

HrT(R) 

OEl.TA(RD) 

HDTCRO) 

0. 

0.: 

0. 

0. 

0. 

10. 

-.1114CE4-00 

-.1C1Z2E-02 

-.11C23E-01 

.36163E-3V 

?0. 

-.33143E+a0 

.4C3GCE-01 

-.54256E-C1 

.11042E-01 

?0. 

-.15?43E*01 

.2t397FfC0 

-.1«455E4C0 

.'45730E-31 

<»0. 

-.32944-*Cl 

.11  CE6£*C1 

-.13e76E4-C0 

.ZlAZoE^oO 

59. 

-.55752P+01 

.4P3C8E+  01 

-.45025E+C0 

.'471405403 

TIHP 

OELTACAZ.) 

HOKAZ.) 

OELTA(EL.) 

HOT(EL.) 

3. 

0. 

C. 

0. 

9. 

13. 

-.47217E-07 

.81.891E-08 

--.12995E-C3 

-.224185-23 

?0. 

-.1u5D4E-02 

.2li822£-25 

-.4‘'858E-C3 

-.234795-05 

33  . 

-.14593E-02 

.li.360E-04 

-.84824E-03 

-.37740^-03 

40. 

-.ISZSOE-OE 

.4fc656E-04 

-.12631E-G2 

-.73028E-05 

50  . 

-.99237E-03 

. 1C74oE“C3 

-.16995E-02 

.9130  4E-C5 
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Mon 

w/o 

•CT 

-L  2 

''I3ISE 

S 1 

EPSITRIIE= 

PP‘;iO= 

ITPPaTION 

.1C:0CE  + C1,  .2.J3C0 

C . y 0 . 

# 1 

E4>01y  .33G30E«0i 

» 0. 

IMP 

HELTa  (Se-l) 

HDT{‘?P1) 

OELTA  (SE2) 

HOT{?F2> 

OELTA  (SF3) 

H'3T(SP3) 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

IG. 

-.23E-01 

-.23E-0? 

.95E-02 

.llF-02 

.53E-02 

-.13E-32 

20. 

..S0E-G2 

.11E-C2 

.72E-C2 

.7CE-02 

.5GE-04 

-.15E-02 

30  . 

.46E-01 

.42E-C2 

.24E-01 

. 20F-01 

.53E-02 

.41E-32 

40. 

.T4E-C1 

.1-"E-01 

.‘i4E-ul 

.42F-G1 

.52E-01 

.33E-01 

50. 

.32E-C1 

.74E-C3 

.2CE-01 

. 12E-01 

.71E-01 

.31E-01 

•tihe 

TP4CF  OF 

DISPERSION 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
EPROR  IN 
TETA 

ESTIMATE 
ERROR  IN 
P^I 

9. 

0. 

•lOE^Sl 

.20E4^^01 

.30E't^01 

10. 

.46353E-C3 

-.57E-02 

-.19E-01 

-.24E-01 

23. 

.7151PE-04 

.2EE-01 

.14E+00 

.1SE+9C 

30. 

.43267F-04 

.71E-01 

.TlEfOO 

.31E^30 

49. 

.92953E-05 

-.31E<-DC 

.49E«30 

-.30E*-00 

53. 

.45a42E-05 

-.58E+3C 

.SIE^OO 

-.71E+00 

Table  C- 


MOOFL 

W/0  •IDI«: 
K1  = 

? £p*;iTRnE  = 

E Eo'lins 

1 TTt^ATION 

. lO^’OCE  + Ol, 
.15^72£*Glf 
^}  2 

.2o0CGE^01, 

. 14913E+01, 

.30Ga9E^01 
. 37  G 5 0 1 

3ELT4(P) 

HCT (R) 

orLTA(Rn) 

H3T(90) 

3. 

0.  0 

• 

G. 

*0. 

13. 

.^7229E-C2 

.12994E-G2 

.26565E-C3 

.39597E-04 

23. 

-.37120E-01 

. Ji-geSF-O’ 

-.1C353E-01 

-.12999E-02 

30. 

-.26240£*00  . - 

.37119E-01 

-.48e91E-Gl 

-.57350E-C2 

40. 

-.16711E+01 

. 16733E4.00 

-.25992E+G0 

-.SISESE-Ol 

SC. 

-.52?33E*01 

. 7U666E4-0a 

-.4C800E+CO 

-.73dE7E-01 

TIHF 

0ELTA(A7.) 

HOT(AZ.) 

OELTA(EL.) 

►4DT(EL.) 

3. 

0. 

0. 

0. 

0. 

10. 

.36432E-04 

.19120E-06 

.10253E-04 

-.13279E-0S 

20. 

.94892E-04 

-.37362E-07 

.49718E-04 

.47120E-07 

70. 

.148o7E-03 

-.11655E-05 

.11235E-03 

• 4o285E-05 

40. 

\ 

.142‘;6E-03 

-.53313E-a5 

.21777E-G3 

.52312E-05 

SC. 

-.27417E-04 

-.1CC50E-C4 

.•36037E-G3 

-.2257gE-05 

1 


Table  C-XXXV-b 


2 

w/0  *nisir 

K1  = 1 

EBSITRUEs 

EPSIOs 

ITERATION 

.10:QljE*01,  .2300CE+01  , .3000CE+01 

.J5772E^C1,  .14-913001,  .37:54E*fll 

? 

TIM? 

''ELTft  (srt) 

HOKSFl) 

CiEL*^A(SF2)  H0T(SF2)  DELTA(SF3)  H3T(S=’3) 

0. 

0. 

0. 

0.  0.  0.  0. 

10. 

-.13E-01 

. 5 •*  E “0  H 

-.32E-01  -.iaE-03  -.31E-01  .84E-04 

20. 

.31E-G2 

-.I'JE-OS 

-.35E-02  •.72E-03  -.12E-01  .16E-03 

3C  . 

-.29E-03 

-.SaE-OS 

-.EOE-02  -.2GF-02  .ISE-Ol  -.54E-03 

40. 

-.80E-02 

-.24E-02 

-.SOE-01  -.68F-02  .4C.E-01  -.62E-02 

SO. 

.29E-01 

.30E-03 

-.e4E-01  22E-C2  .ieE-01  -.12E-01 

TIME  TRADE  OE 

OISPERSIO*^ 
MATRIX 

ESTIMATE  ESTIMATE  ESTIMATE 

ERROR  IN  EPROR  IN  ERROR  IN 

PSI  TFTA  PMI 

0« 

0. 

-.58E+00  .SlE+aO  -.71E+00 

10. 

.473S0E-03 

.70E-02  .29E-01  , .33E-01 

23. 

.24E-02  -.46E-02  -.94E-03 

33. 

.40756E-04 

/ 

.28E-03  -.3SE-01  -.24E-01 

40. 

.8610aE-05 

.56E-01  -.55E-01  .61E-01 

SO. 

1 

.42976E-05 

.llE+90  -.70E-01  .14E*-.00 
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TabI 


e C-XXXVI-a 


MOOTL  2 '■PSIT3!Ui= 

M/0  MOIS?  F“«?ro  = 

<0=1  ITERATION 

.io:ccE*ci, 
.'’8767E  + 30, 
n 7 

.23jJCE+(;1, 

.207C4E+01, 

.33C03E+01 

.285i5E«-01 

TIMF  delta (R) 

HOT(R) 

DELTA  (RO) 

HDT(RO> 

f!.  0.  0 

• 

0. 

0. 

1C.  -.21774t-P2 

.l?970E-03 

-.12925E-03 

.20782E-D5 

20.  .30015E-02‘ 

.1C318E-02 

.13ig0E-02 

.31187E-C3 

30.  .319?^E-C1 

.79389E-02 

.67859E-02 

.13227E-C2 

40.  .25C39E+03 

.42551E-U1 

.43C39E-C1 

.59327E-Q2 

50.  .35231E+C0 

.lt4  07E<-0C 

.65771E-01 

.15905E-01 

TIME 

0ELTA(A7.)  • 

• H0T(A2.). 

OELTACEL.) 

^0T(EL.) 

0. 

0. 

0. 

0. 

10. 

-.99205E-C5 

-.3333&E-07 

-.27910E-C5 

.22293E-07 

20. 

-.24413E-04 

.19882E-07 

-.12259E-C4 

-.44184E-07 

30. 

-.36829E-C4 

.2«638E-o6 

-.25815E-C4 

“. l4806E-0a 

40  . 

-.36239E-C4 

.12769E-05 

-.■♦6991E-04 

• 

-.16201E-03 

53. 

-.31o95E-05 

..322C9E-05 

“ •74743E-04 

.443&2E-0S 

i 

j 


Table  C-XXXVI- 


HDOTL  2 EOSITRIIE=  .lOOGOE  + 01,  .2DJ:0E*01,  i33300E*01 

W/0  rJTISE  E°*:T0=  .?S767E  + 10,  .2G^04F*01,  .23566E  + 01 


KT  = 1 

ITERATION 

» 7 

• 

TIME  Mc-i.rA(3Pl) 

DELTA  (SF2) 

H3T(FF2) 

DELTA  (SF3) 

SDT(SF3) 

0.  9. 

0. 

0. 

0. 

0. 

0. 

10.  .’3E-02 

.30E-35 

.r5E-02 

.27P-04 

.S'^E-OE 

-.3*.E-34 

20.  -.'‘2E-a3 

, .38E-34 

.e7E-03 

.18E-03 

.20E-02 

-.4aE-i4 

30.  -.llE-a3 

.12E-03 

.12E-02 

.61E-03 

-.25E-Q2 

.13E-a3 

40.  .15E-C2 

.5:e-03 

.67E-02 

. 15F»u2 

-.73E-02 

.13E-02 

50.  -.48E-C2 

-.56E-a4 

.llE-01 

.46E-03 

-.25E*02 

.25E-02 

TIME 

TRACE  OF 

OISPERSION 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

estimate 

ERROR  IN 
TETA 

ESTIMATE 
EPRDR  IN 
PMI 

0. 

0. 

.ilEi-OO 

-.70E-01 

.14E4'0C 

10. 

.47472E-03 

-.79E-fl3 

-.45E-02 

-.60E-02 

20. 

.?»802‘)E-04 

.24E-03 

.26E-02 

.25E-02 

’0. 

.41112E-04 

.94E-03 

.84E-a2 

.72E-02 

40. 

.8'6423E-05 

-.12E-01 

.IFE-ai 

-.12E-01 

50. 

.42562E-05 

-.23E-fll 

.16E-01 

-.29E-01 
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Table  C-XXXVII-a 


HOnFL  2 cPSITPUEs 

M/0  ‘niSE  EPSIO= 

•fO  * 2 ITERATION 

.iecocE+01, 

C . t 

n 1 

.2030CE4-01) 

C . (3 

.3GJCaE40l 

• 

TIMP 

3ELTA (P) 

HOT  CR» 

DELTA(^D) 

H3T(RD) 

C. 

0. 

3. 

0. 

0. 

1C. 

-.1C141E*00 

-.81423E-03 

-.10342E-C1 

.92151E-03 

20. 

-.22180-*30 

.2f538E-01 

-.17767E-C1 

.35313E-02 

30. 

-.52395E+00 

.37175E+00 

-.74823E-01 

.52518E-01 

■ 4C. 

-.20768E+01 

.1E738E+01 

-.24014E+00 

.23245E+00 

*50. 

-.S1687E+01 

.463C8E4-01 

-.63C65E+-00 

.41432E+0C 

TIME 

DELTA(AZ. ) 

HOT(A2.) 

DELTA  (El..) 

HDKEL.) 

1 

0« 

0. 

0. 

.0  . 

0. 

10. 

-.40597E-C3 

.12646E-08 

-.112&2E-03 

-.15022E-'0& 

20. 

-.36017E-D3 

.21523E-35 

-.42659E-03 

-.21173E-05 

30. 

-.121775-02 

.14649E-G4 

-.35720E-C3 

-.dD521E-05 

40^ 

-.12553E-02 

.4P877E-C4 

-.13133E-02 

-.71926E-05 

50. 

-.82728E-33 

.1C237E-C3 

-.17232E-C2 

.81415E-05 
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Table  C -XXXVI I -b 


Minrt  2 EO?5ITPilE=  .lOaCCE  + 01,  .23330E  + 01,  .33000E*01 

M/0  *mse  EPSio=  c.  » g.  ,0. 


KT 

s 2 

ITERA'^ION 

» 1 

TIME 

'''■LTft(SEl) 

HDT(E“1) 

0ELTA(SF2)  H0T(?F2)  DELTA(SF3)  H0T(SF3» 

0. 

0. 

0. 

0.  0. 

0.  0. 

10  . 

-.18E-C1 

-.24E-03 

.!C£-C2 

72E-u3  .4CE-02  -.92E-03 

20. 

.47E-02 

. .57E-03 

.66e-02 

80E-02  .23E-03  -.17E-02 

30  . 

.•47E-01 

.53E-0? 

.24E-01 

22F-01  .58E-02  .51E-02 

40. 

.^7E-01 

.12E-01 

.75E-01 

34E-01  .40E-01  .30E-C1 

50. 

.33E-01 

- . 16E-0  3 

.266-01 

16E-C1  .83E-01  .72E-31 

TI^IE  TRA3E  OF 

OIS’FRSION 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE  ESTIMATE 

ERROR  IN  IN 

TETA  PMI 

0. 

0. 

.10E»01 

.2CE4-01  .30E4-01 

10. 

.61260E-03 

-.53E-02 

-.16E-01'  -.2DE-01 

20. 

.57901E-04 

.17E-01 

.10E4>00  .iiE^ao 

33. 

.54652E-0t 

-.llE+30 

.496+00  .52E-01 

43. 

.4096eE-04 

-.2lE+:o 

.58E+00  ^ -.17i+00 

50. 

.12427E-0ir 

.54E+J0 

.33E+00  .llE+01 
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Table  C-XXXVIII-a 


MOnr^  2 PP=>IT=»UE= 

W/0  ‘0I<;E  EP'^TOs 

KO  - 2 ITERATION 

.ICCOCE+ul, 
.*-6  377E+)0f 
« 2 

.2:3CCE<-C1, 

.11578E+01, 

.330jGE^01 

.19330E+01 

TIME 

OELTA{'?) 

HPT(R> 

DELTA(RD) 

H3T(R0) 

. 5. 

0. 

0. 

0. 

0. 

1C. 

-.3«625E-01 

-.2i-656E-03 

-.405‘+9E-02 

. 39542 E“ 04 

20. 

-.91411E-G1 

.12537E-C1 

-.37906E-C2 

.38352E-02 

10. 

-.29922E*nO 

. 13C57E400 

-.36733E-C1 

.23974E-fll 

(»a. 

-.  i:328E»01 

.6rC03E>C3 

. -■.lI84dEf00 

.75909E-01 

!;3. 

-.295C3E4-01 

.17367E*01 

-.28305E+00 

.15317E+00 

TIME 

OELTA(A?. ) 

HOKAZ.) 

DELTA (EL.) 

HOT (EL.) 

0. 

0. 

0* 

0. 

9. 

10. 

-.1525&E-03 

.7C757E-07 

-.422S2E-04 

-.73a00E-07 

20. 

-.32232E-03 

.878C1E-06 

-.15910E-C3 

-.73949E-35 

31, 

-.i»54'4lE-0  3 

.53961E-05 

-,31618E-C3 

-.22324E-93 

uo. 

-.46951E-C3 

.17663E-C‘t 

-.47997E-03 

-.26907E-05 

»^C. 

-.3212'>£-03 

.37653E-04 

-.62221E-C3 

.29153E-05 
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MOn 

w/n 

KO 

=•1  2 
•nisE 
= 2 

FPSITotlE= 

EEx^IOs 

iteration 

. icncoE  + oi, 
.i.e377E  + J0, 
It  2 

.EOOOOE^Ol,  .30C0uE+ai 
.116^6F*01,  .19333E*C1 

TIME 

(fJFl)  HOKS?-!)  n£LTA(SF2)  H0T(;JF2)  nELTA(SF3»  HOT(SF3) 

0. 

0. 

0. 

0.  . 0. 

0.  0. 

10  . 

-.21E-01 

-.23E-04 

-.16E-G2 

30F-a3  -.lOE-02  -.32E-03 

20. 

-.15E-01 

' .35E-03 

.20E-02 

3CE-02  -.14E-02  -.61E-a3 

30. 

-.19E-02 

.2‘iE-C2 

.7EF-02 

d3P-C2  .41E-02  .18E-C2 

40  . 

.^3E-02 

.A7E-02 

.fc4E-02 

12E-ijl  .1?E-01  .llE-01 

50. 

.12E-01 

.14E-03 

-.£3E-02 

59E-02  .34E-01  .26E-ai 

TIME 

TRACE  OP 

DISPERSION 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE  ESTIMATE 

ERROR  IN  ERROR  IN 

TETA  PMI 

3. 

0. 

.54E»30 

.33F+00  .llE+01 

10. 

.&5038E-03 

-.16E-02 

-.74E-02  -.99E-02 

20. 

.96fi97E-04 

.lOE-Ol 

.49E-01  .55E-01 

30 . 

.52999E-04 

-.36E-01 

.20E+C0  .42E-01 

40. 

.38108E-0i* 

-.79E-31 

.22E+aO  -.51E-01 

??r. 

.13J06E>a4 

.ISEfSC 

.30E4>aC  .36E^00 
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Table  C-XXXI 


r 


MonPL 
w/o  fnis 

KO  = 

2 EPSIT?ME= 

E EP3I0= 

2 IT^RfiTTO^i 

. 30COJE+01, 
.S5421E+JC, 

# 3 

.230002+01, 

.169652+01, 

.330002+01 

.264392+01 

Tinr 

9ELTA(R) 

HCT{=?) 

OeLTA(RD) 

9DT(90) 

Q. 

0.  0 

• 

C. 

0.  . 

1C. 

-.133692-01 

.12766E-j3 

-.14216E-C2 

.231312-0+ 

?o. 

-.332332-01 

.4i.623F-02 

-.34316E-C2 

.135912-02 

33. 

-.115722+00 

.t5629E-01 

-.15473E-C1 

.330472-02 

40. 

-.406502+00 

.2C711E+J0 

-.46569E-01 

.259942-01 

50. 

-.114452+01 

.59451E+00 

-.10590E+00 

.520302-31 

TIME 

0ELT4(A7.) 

HOKAZ.) 

OELTA(EL.) 

^^T (EL.) 

0. 

0. 

0. 

0. 

.0. 

10. 

-.525582-04 

.322212-07 

-.14549E-C4 

-.321242-07 

23. 

-.110732-03 

. 31C79E-06 

-.54507E-C4 

-.277012-06 

30. 

-.155722-03 

.154262-35 

-.10753E-C3 

-.775012-35 

40  . 

-.161182-03 

.6C748E-fl5 

-.16195E-C3 

-.943292-35 

50. 

-.112722-03 

. 128242-04 

-.20e43E-C3 

. 335942-05 
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MOO 

M/0 

KO 

FL  2 

'JOISE 

S 2 

EOSITt^iJE* 

EPFIOs 

ITERATION 

.102DOE+01,  .2300CET01,  .33030F*01 
.e5.2lE*00f  .169655+01,  .254395+01 

7 

TIME 

OFLTft{SFl) 

H3'^(SF1) 

DELTA  (SP2) 

M0T(SF2) 

05LTA  (SF3) 

HOT (SF3I 

0. 

0. 

9. 

U. 

0. 

0. 

0. 

10. 

-.i2E-02 

.145-05 

-.llE-02 

.115-03 

-.89E-33 

-.115-03 

20. 

-.315-3? 

.H^E-O? 

.73E-C3 

.1CE-C2 

-.325-03 

-.205-03 

30. 

.195-02 

.925-03 

.265-02 

.285-02 

.185-02 

.625-03 

40. 

.145-02 

.175-02 

.175-92 

.425-02 

.755-02 

.375-02 

50. 

.S15-02 

.805-04 

-.295-02 

.205-02 

.125-01 

.365-02 

time 

TRACE  OF 

DISPERSION 
MATRIX 

estimate 
ERPxOPx  IN 
PSI 

ESTIMATE 
ERROR  IN 
TETA 

ESTIMATE 
ERROR  IN 
PHI 

0. 

c. 

.155+30 

.305+00 

.355+00 

13. 

.645995-03 

-.695-03 

-.395-02 

-.535-02 

20. 

.953105-04 

.375-02 

.175-01 

.195-01 

70. 

.5154x75-0  4 

-.125-01 

.695-01 

.155-01 

40. 

.367625-04 

-.275-01 

. .785-01 

-.175-01 

FC. 

.132335-04 

.445-01 

.105+00 

.115+00 
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•Table  C-XL-a 


MO*)^L 

W/0  ‘HIS 
KH  s 

2 EO«;TTRtJE  = 

E EPSIO= 

3 ITERATION 

.lOGOOE^Ol. 

0 . , 

# 1 

.20000EfCl, 

G.  t 0 

.330C0E«01 

• 

TIMP 

OELTA(O) 

HCT  (P> 

OELTA(RO) 

H3T(RO) 

0. 

0.  0 

• 

0. 

0* 

10. 

-.llllEEfDO 

.95231E-03 

-.1C971E-C1 

.12086E-23 

?0. 

-.34389E+0C 

.42436E-G1 

-.5fi27gE-Cl 

.115C6E-01 

3C. 

-.16820E+01 

.29517E+0C 

-.20072E+0C 

.47349E-01 

40. 

-.36458E+C1 

.14529E+01 

-.17108E^00 

.22167E+00 

' ?0. 

-.62842E+01 

.51182E+01 

-.48677E+C0 

.49102E4-03 

time 

DELTA (AT. ) 

HOT(AZ.) 

0ELTA(EL.) 

HOKEL.) 

P« 

0. 

0. 

0. 

0* 

10. 

-.47103E-07 

.1O0  59E-  07 

-.13567E-C3 

-.23446E-03 

20. 

-.10406E-02 

.28935E-G5 

-.495&2E-P3 

-.28975E-C5 

30. 

-.14404E-32 

.1EC95E-C*t 

-.87172E-03 

-.37907E-05 

40. 

-.14805E-0? 

.5C160E-C4 

-.12876E-C2 

-.77001E-05 

'O. 

-.9R183E-03 

.11025E-03 

-.17252E-C2 

.93308E-05 
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Table  C-XL-b 


MO*) 

W/0 

KiJ 

':l  z 

NOISE 
- ■? 

EeSITP'JEs 

EPSIOs 

ITERATION 

.lOCOOE+01,  .2]30CE*Cli  .3uCJ3E+01 

C.  »0.  >0. 

<»  1 

time 

nPl.TH{SEl)  MDT(SPl)  DELTA  (SF2)  H0T(SF2)  DELTA  (S^T)  H0T(SF3) 

0. 

0. 

0. 

0.  0.  0.  0. 

10. 

-.?4E-C1 

■ -.25E-03 

.67E-02  .llE-0?  .5eE-02  -.14E-02 

20. 

.55E-02 

.llE-02 

.75E-U2  .73E-C2  -.6CE-04  -.14E-02 

30. 

.4SE-01 

.44E-02 

.24E-01  .21F-C1  .5fE-02  .44E-Q2 

40. 

.04E-01 

.19E-01 

.42E-C1  .43E-UI  .52E-01  .38E-ai 

50. 

.T6E-01 

.28E-02 

.18E-01  .13E-01  .72E-C^.  .62E-01 

TIME 

TRACE  OF 

OISBEPSION 
MATRIX 

ESTIMATE  ESTIMATE  ESTIMATE 

ERROR  IN  ERPOP  IN  ERROR  IN 

PSI  TETA  PMI 

0. 

0. 

•IOEtOI  .20E»01  .30E+01 

10. 

.46323E-03 

-.57E-02  -.19E-31  -.23E-0,1 

20. 

.71523E-04 

.27E-01  .14E4-00  .17E+30 

30. 

.440r9E-04 

.79E-ai  .30ETQC  .SIE+OO 

40. 

.Rfi263E-C5 

-.34Ef3C  .51E+00  -.34E+0C 

50. 

.45-,60E-0.P 

-.63£>10  .55E»00  -.TOE^-OO 

■ Table  C-yT.I-a 


MOn^L 

M/0  Mils 
KO  = 

2 ‘*»SITeiJE=  .10:00E  + 01, 

E FPSIO=  .16293E*01| 

3 ITERATION  # 2 

.23a0CE+01, 

.1447?Ev01, 

.30C00E+01 

.37397E+01 

TIMP 

OELTA(^) 

HrT(R) 

0ELTA(R9) 

HOT  CRO) 

0. 

0. 

0. 

0. 

0. 

10. 

.835/5E-C2 

.lESi^SE-Oa 

.27010E-03 

.48708E-34 

20. 

-. 373A3E-C1 

-.41188E-02 

-.113:'7E-!)1 

-.15379E-32 

33. 

-.27727E+00. 

-.39183E-01 

-.50411E-01 

-.53069E-C2 

40. 

-.17105E+01 

-.2?092E«-00 

-.27364E+C0 

-.36350E-01 

50. 

-.35733E+01 

-.879C9E+00 

-.43357E*00 

V 

-.32588E-UI 

TI»*E 

OELTA(AZ.) 

HOT(AZ.) 

OELTA(EL.) 

' 1 

H3TCEL.) 

0. 

0. 

0. 

0* 

0. 

10. 

.42069E-34 

.20033E-06 

.12405E-C4 

-.20118E-C5 

^0, 

.10829E-03 

-.8F209E-07 

.S9238E-04 

.52565F-C7 

30. 

.1&678E-C3 

-.l‘‘44lE-!35 

.13156E-D3 

.53193E-05 

40. 

.15790E-03 

-.67109E-05 

.25C15E-03 

• 3 838  9 E*3 i 

50. 

-.28177E-04 

-.lf438E-04 

.41C81E-C3 

-.25523E-05 
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Table  C-XLI-b 


M^OPL  2 

W/0  nils? 

K1  = 3 

EPSITPiJE* 

EPSIOs 

iteration 

.1C;0CE*01,  .2:30CE4-01,  .sooooe^oi 

.J6297E  + ai,  .14^73E*-01,  . 37337E«-01 

n 2 

TIM? 

nPLTftCSFl) 

3EL’A(SF2)  H0T(5F2)  0ELTA(SF3)  HDT(S-3» 

0. 

0. 

0. 

C.  0.  0.  pa 

10  . 

-.19E-01 

.63E-04 

-.33E-U1  -.13F-03  ..  -.33E-01  .96E-0'4 

20. 

.76E-02 

-.l’E-a3 

-.C4E-C2  -.eeF-03  -.12E-01  .17E-03 

30. 

-.27E-03 

-.B3E-03 

-.f8E-C2  -.31E-02  .17E-01  -.6&E-03 

40. 

-.lOE-01 

-.31E-02 

-.F3E-01  -.79F-02  .48E-01  -.71E-02 

50. 

.29E-01 

-.llE-03 

-.70E-01  -.27E-C2  .19E-01  -.13E-C1 

TIME  T^ACE  0? 

OlfJPE^^SION 

MATRIX 

ESTIMATE  ESTIMATE  ESTIMATE 

ERROR  IN  ERROR  IN  ERROR  IN 

PSI  TETA  PHI 

0. 

0. 

-.63E»a3  .S5E+00  -.79E»00 

10. 

.47208F-03 

.82E-02  .34E-01  .4&E-01 

20. 

.67445E-C4 

.3CE-02  -^56E-b2  -.92E-03 

30. 

.41744E-04 

-.72E-03  -.TSE-Ol  -.23E-01 

40. 

.89355E-05 

.70E-C1  -.79E-01  .73E-01 

50. 

.42682E-05 

.14E+10  -.90E-01  .13E»0C 
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Table  C-XLII-a 


Monri  2 

M/O 

KT  s 3 

EPSITP.UEs 

EPSIO= 

ITERATION 

. jOOU3E+ul. 
.J-6310E  + UC, 

« 3 

.2u039E+01, 

.20395E+01, 

.30333E+01 

.28219£»01 

TIME 

DELTA (R) 

HCT  (R) 

DELTA(RO) 

-IOT(Rri) 

0. 

0. 

0. 

0. 

0. 

10. 

-.263:.6E-02 

-.2E751E-03 

-.17999E-03 

.33762E-33 

20. 

.4320FE-02 

.127f>2E-C2 

.i6919E-C2 

.39499E-03 

30. 

.39057E-01 

.lG0e9E-3i 

.3.0  014E-C2 

.IS979E-02 

40. 

.29912E+03 

.5t353E-0i 

.31427E-01 

.33344E-02 

FC.  ' 

• 10235E«^01 

.21073E+00 

.79711E-01 

.21825E-01 

TIME  - 

OELTA(AZ.  ) 

HOKAZ.) 

OELTA(EL.) 

HOT(EL.) 

0. 

0. 

0. 

0. 

0. 

10. 

-.12155E-04 

-.4C389E-07 

-.35870C-C5 

.27l24ErC7 

20. 

-.29SC9E-04 

.3C074E-07 

-.15727E-04 

-.55206E-0? 

30. 

-.44509E-04 

.3Pg59E-05 

-.32912E-C4 

-.13346E-03 

40. 

-.43111E-04 

.1&346E-05 

-.593‘^0E-04 

-.19527E-03 

. SO. 

-.2S606E-05 

.41012E-05 

-.94142E-C4 

.5&O51E-0S 
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table  C-XLII-b 


HOOFL  2 

EPSIToije= 

.10  0CGE4-31»  .20J30 

E^Glf  .TOulQE^Ol 

M/0 

K1 

NOISE 
= 3 

EeSTO= 

ITERATION 

.f631CE+3C,  .2C395 

» 3 

E>01f  .asiiBE^oi 

TIME 

MELTA  <SF1) 

MOT(SFl) 

DELTA  (SF2) 

H0T(SF2) 

delta  (SF3)  M3T(SF3) 

0. 

0. 

t 

0. 

0. 

0. 

0.  0. 

10. 

.29E-02 

.37E-05 

.65E-02 

.35E-04 

.65E-02  -.43E-04 

20. 

-.llE-02 

.4EE-04 

.73E-03 

.23E-03 

.23E-02  -.47E-C4 

30. 

-.llE-03 

.13E-03 

.15e-02 

.77E-C3 

-.32E-C2  .17E-33 

40. 

.21E-02 

.7QE-03 

.lOE-01 

. 19E-C2 

-.39E-02  .17E-C2 

SO. 

-.35E-02 

.llE-04 

.13E-01 

.62F-C3 

-.31E-02  .31E-02 

TIME  TJ?A3E  OF  ESTIMATE  ESTIMATE  ESTIMATE 

OIS?E''.SION  ERROR  IN  ERROR  IN  EPRDR  IN 


MATRIX 

PSI 

TETA 

PHI 

0. 

0. 

.14E^00 

-.90E-01 

.13E+00 

10. 

.47352E-03 

-.llE-02 

-.SOE-02 

-.30E-02 

20. 

.6ai64E-04 

.18E-03 

.30E-02 

.23E-02 

30. 

.42132E-04 

.13E-02 

.lOE-01 

.i9E-02 

40. 

.89710E-05 

-.16E-C1 

.19E-01 

-.17E-01 

PO. 

.42659E-05 

-.31E-01 

.22E-01 

-.•♦OE-Ol 

Table  C-XLIII-a 


MOOFL 

HI-'M  M-) 
= 

2 EPSITRiJE  = 

ISE  EPSTOs 

1 ITERATIOM 

.ic:ooE*oi, 

G • » 

« 1 

.20000E4>01y 

G.  , 0 

.30030E4-01 

• 

TIMf 

OELTA (R) 

HCT(R) 

OELTA(RO) 

H3T(RO) 

0. 

.11254E+02 

. 11254E+02 

.92099E*C1 

.92098£«^0i 

10  . 

.l5«9tE+C2 

. l'0C4E+02 

.106‘.9E»C2 

.10&60E4-02 

20. 

.70100E+C1 

.73817E+01 

-.11887E+C2 

-.11321E+02 

■ 30. 

-.135a0E*02 

-.11642E+02 

-.11799E«-02 

-.1156dE*02 

40. 

-.1770SE+32 

-.13091E>02 

.105C4E4-02 

.ia957E*02 

98. 

-.24156E+C2 

-.17660E+02 

-.12048E^02 

-.11126E+02 

TIME 

0ELTIJ(A7.) 

H07(AZ.) 

DELTA(EL.) 

H0T(EL.) 

0. 

-.15561E-C2 

-.15561E-02 

.902i7E-C3 

.9a217E-03 

10. 

.90309E-03 

.17752E-02 

.59938E-C3 

.72912E-G3 

?0. 

-.  92665E-03 

.22642E-03 

-.17735E-C2 

-.12978E-02 

'30. 

-.16088E-02 

-.2C617E-03 

-.474U3E-03 

.35S98E-C3 

40. 

-.768P3E-03 

.er539E-03 

-.82300E-C3 

.43234E-03 

50. 

-.1D23CE-02 

.71117E-04 

-.13624E-C2 

.34527E-03 
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HOniiL  2 

WITH  M.TIiE 
<r5  s 1 

epsitpije= 

EPSIO= 

ITEf^ATION 

.1CC00E4-01,  . 20300 

0 . f 0 . 

n 1 

E*01,  .33C03E+01 

f 0. 

riM£  TELT4(SF1) 

H3T(<;ri) 

HELTA  {SP2) 

H0T(5:F2) 

OELTfi  (SF3) 

40T(SF3) 

0.  -.llE-01 

-.llE-01 

.35E-01 

.35E-01 

-.30E-01 

-.30F-01 

10.  .23E-01 

.43E-01 

-.I9c-01 

-. 27E-01 

.67E-02 

-.‘*9E-03 

20.  .-»4E-02 

-.49E-03 

-.4CE-C1 

-.4CE-C1 

.19E-01 

.17E-ai 

30.  .7‘3E-01 

.33E-01 

.f4E-Cl 

.60E-01 

.22E-01 

.21E-01 

40.  .33E*C1 

.63E-02 

.21E-01 

. 19E-01 

.57E-fll 

.42E-01 

5C.  .q/E-Ol 

.54E-01 

-.e4E-01 

-<.72E-01 

.78E-01 

.68E-01 

IME 

TRACE  OF 

DISPERSION 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
ERROR  IN 
TETA 

ESTIMATE 
ERROR  IN 
PHI 

0. 

0. 

ilOE+01 

.20E+01 

.33E+01 

10.  . 

.17185E-04 

-,11E*30 

-.54E*00 

-.75E4-00 

20. 

,13880F-05 

-.19E-01 

-.43E-01 

-.7SE-01 

30, 

.37915E-06 

-.65E-02 

-.18E-01 

-.41E-01 

40. 

..16911E-0E 

.13E-01 

-.llE+00 

-.15E<>3C 

•50. 

.10749E-06 

,79E-01 

-.17E+00 

-.14F+-00 

Table  C-XLIV-a 


MOOFL  2 FOSITRUE= 

WITH  NOISE  EP<;iO= 

<0=1*  ITFRATION 

.10CGCE4-31) 

.92144E+00, 

P 2 

.233CCE<-01, 

.21SS8E*01, 

.33C30E^01 

.31333E+01 

TIME 

OELTA(R) 

•HCT(R) 

OELTA(RO) 

■«3T(R0> 

0. 

.11254E+02 

.11254E+U2 

.92098E+01 

.92098E+31 

10. 

.l7012E«-32 

.170C5E»C2 

.1C6&0E4-C2 

.ia56uE4>C2 

20. 

.73653E+C1 

.73793E4-01 

-.11828E+C2 

-.11833F+32 

?a. 

-.118C2E+02 

-.11943E+02 

-.11598E+C2 

-.11517E+02 

40. 

-.14150E<:02 

-.  14574E+02 

.10672E+C2 

.10531E+02 

50. 

-.17811E+02 

-.  iea61E+02 

-.11536E+02 

-.11623E+02 

TIME 

0ELTA(A7.) 

HOT(A2.) 

OELTA<EL.) 

H0T{EL.) 

0. 

-.15561E-02 

-.155eiE-02 

.90217E-03 

.90217E-03 

10. 

.14G3aE-02 

.13752E-02 

.73697E-C3 

..72937E-03 

20. 

.28442E>C3 

.22357E-03 

-.12678E-C2 

-.12948E-02 

30. 

-.13699E-03 

-.22132E-03 

.42004E>03 

.37412E-03 

40. 

.34433E-03 

.75411E-03 

.50517E-C3 

.44057E-03 

50. 

.29948E-04 

-.42153E-04 

.41935E-03 

.33674E-C3 
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V 


Table 


MODEL  2 
WITH  NOISE 
<0  = 1 

EPSITRUE= 

EPSIO= 

iteration 

.1C00CE*01,  .2300CE*01,  .3CC3JE+31 

.92144E+JC,  .aiSeSE^Ol,  .31393E+01 
#2  ' . 

TIME 

DELTA  (SFl)  ^DT(SEl)  0EL7A(SF2)  H0T(SF2)  0ELTA(SF3)  HOTCS^J) 

0. 

-.llE-01 

-.llE-Cl 

.35E-01  .35E-01  -.30E-01  -.30E-01 

10  . 

.•»0E-C1 

.44E-C1 

-.26E-01  -.28E-01  .29E-02  .90F-03 

20. 

-.33E-02 

-.i:’E-C2 

-.47E-01  -.47E-01  .20E-01  .19E-01 

30. 

.15E-C1 

.26E-01 

.38E-01  .39F-01  .15E-01  .17E-01 

40. 

-.26E-01 

-.12E-01  . 

-.24E-01  -.26E-01  -.24E-02  .25E-02 

SO. 

.57E-01 

..63E>01 

-.83E-01  -.85E-01  .12E-02  .42E-02 

TIME 

TRACE  OF 

QISPERSION 
MATRIX 

ESTIMATE  ESTIMATE  ESTIMATE 

ERROR  IN  ERROR  IN  ERROR  IN 

PSI  TETA  PHI  . 

0. 

0. 

.79E-01  -.17E*0C  -.14E»00 

10. 

.17346E-04 

-.lOE+30  -.54E+00  -.75E<-00 

20. 

.13370E-05 

-.19E-ai  -.31E-01  -.63E-01 

33. 

.38091E>06 

-.13E-C1  .23E-01  .41E-02 

43. 

.16695E-06 

-.12E-01  .71E-02  -.33E-02 

SO. 

.10769E-06 

-,19E-01  -.17E-01  -.23E-01 

Table  C-XLV-a 


MOO'L  2 
WITH  NniSE 
KO  s 1 

EPr?ITRUE= 

EOSIO* 

ITERATION 

.lOODOE+Olf 
.10192E+01, 
if  3 

.2000GE4-01t 

.20172E+01, 

.30000E+01 

.30226E+01 

TIME 

0£LTA{R) 

HCT(R) 

DEl.TA(RD) 

HDT(RO) 

0. 

.11254E+02 

.11254E+02 

.92098E4-01 

.92098E«01 

10. 

.17006E+0? 

.17005E+02 

.106&0E1-02 

.13o60E4>a2 

20. 

.r34t3E+01 

.734C9E+01 

-.11832E4>C2 

-.11333E*-02 

?0. 

-.11912n+02 

-.11929E+02 

-.11612E<'C2 

-.11514E+02 

1.0. 

-.14463E+02 

-.l‘-505E+02 

.10645E+C2 

.13541E+02 

53.' 

-.18532E+32 

-.leesoEtoa 

-.11593E»C2 

-.11501E+02 

TIME 

OELTACAT. ) 

HOTtAZ.) 

OELTA(EL.) 

H3T(EL.) 

0.  . 

-.155&1E-G2 

-.15561E-02 

.90217E-C3 

.93217E-03 

10. 

•137S9E-02 

.137E2E-02 

.73C36E-03 

.72334E-03 

20. 

.23199E-03 

.22372E-03 

-.12912E-02 

• 

-.l29‘49E-02 

3C. 

-.209C3E-C3 

-.22063E-03 

.38033E-C3 

.37381E-C3 

4?. 

.76859--C3 

.7E636E-C3 

.44S82E-03 

•44020E-03 

SG. 

-.28292E-C4 

-.37177E-04 

.34996E-03 

.33703E-33 
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P 


HOHEL  2 
WITH  MDISE 


Table  C-XL 


EPSITRUEs  .lOOOOE+Ol,  .SlOOCEfOl,  .TOCOOE+Ol 
EO^TOs  .1D192E+01,  .2D172E+01,  .30225E^01 


KO 

= 1 

ITERATION 

» 7 

IM- 

DELTA  (S^l) 

MDT(Sri) 

OELTA  (SF2) 

H0T(SF2) 

OELTA (SF3) 

H0T(SF3) 

0. 

-.llE-01 

". llE-0 1 

.75E-01 

.35E-01 

-.30E-01 

-.30E-01 

10. 

.•►5E-01 

.44E-01 

-.28E-01 

-. 26E-01 

.37E-03 

.85E-03 

20  . 

-.30E-03 

-.16.E-02 

-.47E-01 

-.hTE-OI 

.19E-C1 

.19E-01 

30. 

.37E-01 

.2ftE-01 

.40E-C1 

.40E-01 

.17E-01 

.17E-01 

40. 

-.lOE-01 

-.llE-Gl  ' 

-.23E-01 

24E-01 

.39E-02 

.42E-02 

50. 

.63E-C1 

.63E-01 

-.e4E-Cl 

-.84E-C1 

.66E-C2 

.67E-02 

Tins  TRACE  OF 
DISPERSION 


ESTIMATE 
ERROR  IN 


ESTIMATE 
ERROR  IN 


ESTIMATE 
ERROR  IN 


- 

MATRIX 

PSI 

TETA 

PMI 

0. 

0. 

-.19E-01’ 

-.17E-01 

-.23E-01 

19. 

.17342E-04 

-.lOE+00 

-.54E+00 

-.75E*-0  0 

20. 

.13970E-05 

-.19E-01 

-.32E-01 

-.64E-01 

30. 

.38094E-06 

-.13E-01 

.21E-01 

.17E-02 

49. 

.15597E-06 

-.lOE-Ol 

.16E-0  2 

-.llE-01 

•?o. 

.10770E-06 

-.15E-01 

-.24E-01 

-.23E-01 

Table  C-XLVI-a 


HOOPL  ? EPSITRI>E=  .lOOOOE  + Olt  .2000CE»01,  .3000aE»01 
WTth  m-iisc  EP‘?I0=  L.  ,0.  , C. 

KH  a 2 ITERATION  A 1 


THE 

DELTA (R) 

HCT(R) 

DELTA  (RO) 

HDT(RO) 

0. 

.11254E+C2 

.11254E+02 

■ .9209dE*01 

.9209SE«-ai 

10. 

.16904Ef02 

. 17004E+02 

.10649E+02 

.13S60E4-32 

20. 

.71201E4-C1 

.736g9E+31 

-.11850E*C2 

-.11323E+02 

10. 

-.12550E*02 

-.11594E+02 

-.11659E*02 

-.11552E+C2 

40. 

-.16571E+Q2 

-.12920E+02 

.104C3E4>02 

.ia945E^02 

50. 

-.24759E+02 

-.17960E+a2 

-.12228E+02 

-.11183e«-02 

TIME 

OELTA(A*».) 

HOTCAZ.) 

DELTA(EL*) 

4DT(EL.) 

0. 

-.155S1E-02 

-.15561E-02 

.90217E-03 

.90217E-03 

10. 

.96924c-C? 

.17752E-02 

.61672E-03 

.72919E-03 

20. 

-.63643E-03 

.22589E-03 

-.17215E-C2 

-.12971E-02 

30. 

-.14362E-C2 

-.2C588E-03 

-.48344E-C3 

.3o770E-03 

40. 

-.49859E-03 

.8C561E-03 

% 

-.37817E-03 

.43295E-03 

50. 

-.96363E-03 

.bf028E-04 

-.13911E-02 

.34523E-03 
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Table  C-XLVI-b 


MOOFL  2 

WITH  NOISE 

KO  = 2 

rosiT?iJE  = 

EOSIO* 

ITERATION 

.lOQQOE^Oly 

C.  y 

» .1 

.2C030E4-01y  .33CC0E>01 

0 . f 0 . 

■IME 

f'ELTA(SP’l)  HOT(SFi)  0ELTft(SF2)  H0T(SF2)  DELTA  (SF3)  H0T(SF3) 

0. 

-.llE-Ol 

-.llF-01 

.35E-01 

35E-01  -.30E-01  -.30E-01 

10. 

.25E-01 

.43E-01 

-.23E-01  -. 

27E-01  .49E-02  -.79E-34 

20. 

.31E-02 

-.13E-02 

-’.38E-C1  -. 

39E-01  ’ .19E-01  .17E-01 

^0  . 

.73E-01 

.32E-01 

.e4E-01 

62F-01  .23E-01  .22E-01 

40. 

.37E-01 

.16*^0  2 

.125-01 

llE-01  .44E-01  .35E-01 

50. 

.lOE^OO 

.63E-31 

-.fOE-Ol  -. 

68E-01  .90E-01  .79E-01 

TINE 

TRACE  OF 

OISRERSION 
MATRIX 

ESTIMATE 
E'^ROR  IN 
RSI 

ESTIMATE  ESTIMATE 

ERROR  IN  ERROR  IN 

TETA  PHI 

0. 

0. 

•lOEiOl 

.20E<-01'  .30E+01 

13. 

•22566E-0L 

-.12E+00 

-.S3E+00  -.37E«-00 

20. 

.193595-05 

-.22E-01 

-.41E-01  -.7dE-01 

30. 

.50420E-06 

-.12E-C1 

-.35E-01  -.59E-01 

40. 

.22737E-C6 

.39E-02 

-.lOE^OO  -.14E«-00 

1 

53. 

.13519E-06 

.63E-C1 

.-.16E4-00  -.12E+00 

1 

-4 


Table  C-XLVII-a 


MOn^L 
with  mdi*; 

Kl  = 

2 rf»«;iT=>U£  = 

Z EPSIOs 

2 ITERATION 

.lOOOOE+Olr 

.93705Ef30, 

# 2 

.20000  14-011 
.216C7E4.01, 

.3030QE4.01 

.71221E4-01 

’’IHF 

3ELTACP) 

HOT(R) 

DELTA(RO) 

M3T (RO) 

C. 

..11254E+02 

.11254E+02 

.92Q93E4^01 

.92&98E4-ai 

10. 

.17011E+C2 

.170C6E<-02 

.1065aE4-02 

.103SGE4-02 

?s. 

.73576E+C1 

.734C4E+01 

-.11830E4-C2 

-.11933E4-02 

30. 

-.11854E+02 

-.11943E*02 

-.11603E4-C2 

-.11317E4-C2 

>0. 

-.14226E+02 

-.1<;574E*02 

.10674EfC2 

.10333E4-32 

50. 

-.17862E+C2 

-.ie819E+02 

-.11535E4-02 

-.11317E4-32 

time 

DELTA (AT.) 

HOKAZ.) 

OELTACEL.) 

^^TCEL.) 

0. 

-.15561E-02 

-.15561E-02 

.90217E-03 

.30217E-03 

10. 

.13970E-02 

.13752E-02 

.73536E-03 

.72937E-b3  . 

20. 

.26909E-03 

.22361E-03 

-.12729E-02. 

-.12948E-02 

30. 

-.15754E-03 

-.22127E-03 

.41571E-03 

.374065-33 

40. 

.92245E-C3 

.75433E-03 

.50048E>C3 

.44052E-03 

50. 

.14629^-04 

-.41345E-04 

.41l53e-C3 

.33&79E-03 

•nOEL  2 ^P5ITP'IE=  .lOCOOE^-Ol,  .2030CE<-01,  . 33000?  + 01 

WITH  NOISE  EPSIO=  .93705E+30,  .2l6e7E»01,  .31221E+01 


KD 

= 2 

ITERATION 

# 2 

TIME 

''FLTA(SPI) 

MOT(SFl) 

0ELTA(SF2) 

HOT(SF2) 

DELTA  (SF3) 

^OT (SF3) 

0. 

-.llE-01 

-.llE-Cl 

.35E-01 

.35E-C1 

-.3CE-01 

-.30E-31 

13. 

.<*2E-C1 

.‘•4E-C1 

-.27E-dl 

-.  28F-01 

.23E-02 

.88E-03 

1 

20. 

-.39E-02 

-.15E-02 

-.t7E-01 

-.47E-01 

.20E-01 

.19E-01 

30  . 

.15E-01 

.25E-01 

.39E-01 

.39E-01 

.15E-01 

.17E-31 

40. 

-.ElE-01 

-. llE-01 

-.24E-01 

-.  25E-fll 

-.53E-a3 

.31E-02 

50. 

.36E-01 

.5'»E-01 

-.63E-01 

-.35E-01 

.57E-03 

..40E-02 

TIME  TRA:E  of  estimate  ESTIMATE  ESTIMATE 

DISPERSION  ERROR  IN  ERROR  IN  ERROR  IN 


MATRIX 

PSI  • 

TETA 

PHI 

C. 

c. 

.63E-01 

-.IBEi^aO 

-.12E*0C 

10. 

.22696E-C4 

-.iiE+ao 

-.63E«>00 

-.97E»00 

20. 

.19-f76E-0E 

-.21E-01 

-.29E-31 

-.63E-01 

30. 

.50748E-fl6 

-.16E-01 

.22E-01 

-.13E-02 

40. 

.22855E-05 

-.15E-01 

.64E-02 

-.llE-Ol 

5»I. 


13341E-0fc 


22E-U1 


21E-0t 


31E-01 


HODfL 

Wf'H 

K1 

2 EOF! TRUE* 

NDISE.  EP3I0= 

s 2 ITERATION 

.lOSOLE+Ol, 

.1C222£*01, 

# 3 

.aiiaocE^oi, 

.2o213E«-01, 

.330D0E4-01 

.33310E»01 

TIMP 

DELTA(R) 

HCT(R) 

OELTA{RO) 

^3T{R0) 

0. 

.11254E+02 

.11254E»02 

.92093E«01 

.9209SE+D1 

13. 

.17036E+C2 

.17CC5E+02 

.106S3E«C2 

.1035  0E+02 

29. 

.73439E+01 

.77i*i)gE4-Ql 

-.11832E«-02 

-.11S33E+02 

30. 

- -.11919E+02  - 

.11930E+02 

-.11613E+C2 

-.11515E+02 

40. 

-.14470E+02 

.14511E+02 

.10e4SE4^02 

..13541E*02 

FO. 

-.18521E+C2 

.ie640E4-02 

-'.11591E+C2 

-.11602E+02 

TIME 

0£LTA(A7.). 

HOT(AZ.) 

OaTACEL.) 

^OT(EL.)  , 

0. 

-.15551E-02 

-.155eiE-02 

.90217E-C3 

.90217E-33 

19. 

.13794E-02 

.13752E-02 

.73051E-C3 

.72934E-03 

20. 

.23271E-C3 

.22372E-03 

-.12905E-02 

-.12949E-02 

30. 

-.20735E-03 

-.22tJ67E-03 

.38266E-03 

.37382E-03 

40. 

.76990E-03 

.7E624E-03 

.4F330E-03 

.44322E-03 

FO. 

-.27fi57E-04 

-.374C6E-04 

.35495E-03 

.33701E-03 

MOO 

iRL  2 

E»SITRUE= 

.1CGC:E«-01,  .2030 

CE+Cl,  .30 

333E4-01 

NIT 

KO 

H rniSE 
= 2 

EPSIOs 

ITERATION 

.10222E*0lf  .2021 

# 7 

JEfOl,  .30 

313E4-01 

riME 

DELTA (3F1) 

HDT(3F1) 

DELTA {SF2) 

HOT(SF2) 

DELTA  {SF3) 

H0T(SF3» 

0. 

-.llE-01 

-.llE-01 

.35E-01 

.35E-01 

-.30E-01 

-.30E-01 

10. 

.■♦4E-01 

.44E-01 

-.c8E-Cl 

-.  28F-D1 

.82E-03 

.85E-03 

20  . 

-.dIE-03 

-.16E-02 

-.47E-01 

-.47E-01 

.19E-01 

.19E-01 

30  . 

.27E-01 

.26E-01 

.40E-C1 

.40F-C1 

.17E-01 

.17E-01 

40. 

-.lOE-01 

-.llE-01 

-.24E-01 

-,24E-01 

.4CE-0? 

.41E-32 

50. 

.53E-01 

.63E-01 

-.€4E-01 

-.84E-01 

.63E-C2 

.64E-32 

TIME  TRACE  0^  ESTIMATE  ESTIMATE  ESTIMATE 

DISPERSION  ERROR  IN  EP.ROR  IN  ERR3R  IN 


MATRIX 

.PSI 

TETA 

PHI 

0. 

0. 

-.22E-01 

-.21E-31 

-.31E-01 

10. 

.22694E-04 

-.11E4-03 

-.63E^00 

-.37E4^00 

20. 

.19477E-05 

-.21E-01 

-.29E-0i 

-.64E-01 

30. 

.50752E-06 

-.16E-01 

.20E-01 

-.43E-02 

40. 

.22858E-06 

-.14E-01 

.22E-02 

-.15E-01 

-.19E-C1 


13543E-06 


.26E-ai 


.3«»E-fll 


table  C-XLIX-a 


HOn>L 
with  ‘nis 
KO  s 

2 EOSITPjJEs 

E E=»EI0= 

3 ITE^ATIOf 

.lOCOCEfOlf 

u • t 

» 1 

.20300E4-01f  . 

0 . * 

3aCJCE«>01 

time: 

3ELTA(R) 

HOT  (R) 

OELTA(RO) 

^^T{RO) 

c. 

.1125.4E  + 02 

.11254E+02 

.92098E«C1 

.92098E+I)1 

10. 

.16894E+02 

.170C4E+02 

.10649E+r2 

.10360E+02 

23. 

.b197*5E*01 

.73838E+01 

-.11891E+02 

-.11321E^02 

3C  . 

-.13&C8E+02  . 

-.11631E+02 

-.11815E«-C2  . 

-.11567E+C2 

, 40. 

-.  1814CE4-02 

-.13041E4-02  ■ 

.10472E+02 

.10365E402 

50. 

-.24875E+02 

-.13472E+02 

-.12084E4-02 

-.11107E+02 

TIME 

0E‘LTft(A7. ) 

HOT(AZ.) 

DELTA(EL.) 

HDTCEL.) 

0.. 

-.15561E-32  -.lF56kE-G2 

.90217E-C3 

.90217E-03 

10. 

.904ieE-03 

.13752E-02 

. 59 36 7 E- 03 

.72911E-C3 

20. 

-.3i688E-03 

.22fj64E-03 

-.i7906E-02 

-.12978E-02 

70. 

-.16609E-02  -.2C543E-03 

-.49797E-03 

.36696E-03 

40. 

-.72384E-03 

.6C689E-C3 

’-.34742E-03 

.43244E-03 

50. 

-.98319E-03 

.739  04E-04 

-.13861E-C2 

.34542E-J7 
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Table  C-XLIX-b 


i 


HOn^L  2 

MiTM  'nisj 
<■3  = 3 

EPSIT'?tJE  = 

FP3I0= 

ITERATION 

.ic:ocE-»-oi, 

c.  > 

« 1 

.23000E«-01f  .30G00E«-01 

0 . t 0 . 

TIH£ 

OrLTiCSPl)  HOT(SFl)  0ELTA(SF2)  H0T(SF2)  DELTA  (SF3)  HDT(S=‘3> 

0. 

-.llE-Dl 

-.llE-21 

.35E-01  . 

35E-C1  -.30E-01  -.30E-31 

10. 

.iqE-01 

.43E-31 

-.19E-01  -. 

27E-C1  .65E-02  -.52E-03 

20. 

.40E-02 

-.PDE-O? 

-.?QE-ai  -. 

40E-01  .19E-01  .17E-01 

30. 

.’2E-01 

.31E-ai 

.64E-01 

61E-01  .22E-01  .21E-01 

40. 

.33E-01 

.90F-02 

.i9E-Gl 

20F-01  .57E-01  .43E-fll 

50. 

.39E-01 

.65F-01 

-.f6E-01  -. 

71E-C1  .79E-01  .69E-01 

TIHF 

TRACE  OP 

DISPERSION 
H4TRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE  ESTIMATE 

ERROR  IN  ERROR  IN 

TETA  . PHI 

0. 

0. 

.lOE+01 

.20E«-ai  .3CE«-01 

10. 

•17037E-04 

-.llE+OG 

-.54E«-00  t.’5E  + 00 

20. 

.13868^-03 

-.19e-01 

-.42E-01  -.74E-01 

30. 

.38222E-06 

-.57E-02 

-.18F-01  -.42E-01 

40. 

.1691CE-06 

.14E-01 

-.llE+00  -.15E+00 

50. 

.10911E-06 

.85E-01 

-.17E^00  -.14E^00 
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Tabl 


H01-L 
WITH  MOIS 
KD  s 

2 E«»SITRUE= 

E £0^10= 

3 iteration 

.iGJC0c4>ait 

.9l491E«-30, 

# 2 

.2C'00G£4>C1» 

.21703E«'01, 

.33CJ3E4.01 
. 31359E+  Cl 

TIMfT 

OELTACR) 

.HCT(R) 

OELTA(RD) 

H3T{R0) 

0. 

.11254E+02 

.11254E+U2 

.92C9dE^Cl 

.92098E4-01 

19. 

.17912E^C? 

.170C5e<-02 

.1C6S3E+C2 

.19360E«-02 

29. 

.73674E+01 

.77392E*01 

-.11823c*02 

-.11333E+02 

39. 

-.11794E>02 

.11943E+02 

-.11E9TE<-C2 

-.11317E+02 

40. 

-.14128E+02 

.lii576E+02 

.10674E^02 

.12531E«-02 

?0. 

-.17754E«-02 

.1886dE+02 

-.11533E^C2 

-.11323E+02 

TIME 

0ELTA(A7. ) 

HOT(AZ.) 

OELTA{EL.) 

M3T(EL.) 

0. 

-.15561E-02 

-.lr561E-02 

.90217E-C3 

.30217E-03 

10. 

.14027E-02 

’.13752E*02 

.73724E-03 

.72337E-03 

20. 

.28334F.-03 

.22356E-03 

-.12671E-02 

.-.l2948E-a2 

3C. 

-.13932E-03 

-.22136E-03 

.42073E-03 

.37412E-03 

49. 

.84113E-C3 

• .7F405E-03 

.50545E-C3 

.^4057E.-03 

50  . 

.27390E-04 

-.42239E-04 

.•♦1395E-03 

.33674E-C3 
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HOO'L  2 E3'5IT‘?ME=  .iCCOCE^Ol,  .2CiJ00E+01,  . 30010E«-01 

WITH  N3ISE  EPSIOs  .?1491E+-30,  .21703E«-01,  .^13S9E«-01 

KO  = 3 ITERATION  9 Z 


TIME 

OFLTA  (Sri) 

937(3^1) 

DELTA  {SF2) 

H0T(?F2) 

DELTA  (SF3) 

HOT {SF3) 

0. 

-.llE-01 

-.llE-31 

..35E-01 

.35E-ai 

-.3CE-01 

-.33E-01 

10. 

.39E-C1 

.44E-C1 

-■.26E-C1 

-.  28E-C1 

.29E-02 

.90E-03 

20. 

-.92E-D2 

-.l'7E-02 

-.47E-01 

-.•♦7E-01 

.20E-01 

.19E-31 

30. 

.15E-01 

.29E-01 

.3eE-01 

1 

. 39E-01 

.15E-01 

.17E-01 

40.' 

-.26E-01 

-.12E-01 

-.24E-C1 

-.  26E-C1 

-.24E-02 

.25E-02 

50. 

.56E-01 

.63E-01 

-.€3E-01 

-.85E-01 

.12E-02 

.42E-a2 

TIME 

TRADE  OF 

DISPERSION 
NATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
ERROR  IN 

TFTA 

estimate 

ERROR  IN 
PHI 

9. 

0. 

.85E-01 

-.17E+00 

» 

-.14E+30 

10. 

.17247E-04 

-.lCE+30 

-.54E+00 

-.75E»00 

20. 

.13958E-C5 

-.18E-01 

-.29E-01 

-.61E-01 

30. 

.38399E-0fi 

-.13E-01 

.24E-01 

.47E-02 

40. 

.16393E-06 

-.llE-01 

.75E-02 

-.3’4E-a2 

50. 

.1083.2E-06 

-.19E-01 

-.17E-31 

-.23E-01 

■Table  C-LI-a 


MinFL 

M3I3 
K1  s 

2 EPSITRUE= 

£ EPSIO= 

3 ITERATION 

.10:0JE4-01, 

.3ai91E*Cl, 

# 7 

.2j9C0E+Cl, 

.3C173E+01, 

.30030E4-01 

.3J23'’E4-ai 

TI^IP 

3ELTA(PJ 

HCT(R) 

DELTA  (RD) 

H3T(R0) 

0. 

.11354E+02 

.11254E+a2 

.92093E-»01 

.92093E4-31 

1C. 

.179DSE«-02 

.170C5E*a2 

.10660E+C2 

.13&60EV02 

39. 

.73444E+01 

.73409E+01 

-.11832E<-C2 

-.il333E+02 

30. 

-.11911E4-02 

-.11929E+C2 

-.11312E+02 

* 

. -.11&14E+C2 

<»0. 

-.144f>9E+C2 

-.14505E+02 

.10645E«03 

.iaS41E*02 

50. 

-.18527E«'02 

-.lt632E+02 

-.11593E*C2 

-.11S02E+D2 

TIME 

0ELTA(AZ.) 

H0T(A2.) 

DELTACEL.) 

H3T(EL.) 

0. 

-.15551E-Q3 

-.15561E-02 

.90317E-03 

.90217E-03 

10. 

.13739E-02 

.13752E-02 

.73041E-C3 

.72934E-03 

30. 

.23196E-C3 

.2?372e-03 

-.12910E-02 

-.12949E-02 

30. 

-.20919E-03 

-.23064E-03 

.38C55E-03 

.37361E-i)3 

<*0. 

.76841E-03 

.75635E-33 

.•♦5005E-03 

.4402aE-a3 

50. 

! 

i __ 

-.285S7E-04 

-.37203E-04 

.35021E-03 

.33703E-C3 

U3 


Tiible  C-LI-b 


■ HOOPL  2 

WITM  MTIS? 

KO  = 3 

FPSITRIJE= 

E?SIO= 

IT.E'’ATI0N 

.lOOOOE+Clf  .2OQO0F  + O1,  .33000E«'01 

.lC19l£«-01t  .2ul73E^01,  .33227E  + 01 

A 3 

TIME 

HELTACS'^l)  HOKSFl)  DEL7A(SF2)  H0T(SF2)  DELTA  {SF3)  HDr(SF3) 

0. 

-.iiE-:i 

-.llE-01 

.35E-C1  .35E"01  -.30E-.01  -.30E-CI 

10. 

.45F-01 

.44E-jl 

-.28E-01  -..28E-Q1  ,87E-03  .85E-03 

20. 

-.3QE-33 

-.16E-02 

-.A7E-01  -.t7E-01  .19E-01  .19E-31 

30. 

.27E-01 

.29E-01 

.LOE-01  .40E-01  ’ .17E-01  .17E-C1 

40. 

-.lOE-31 

-.llE-01 

-.23E-01  -.24E-01  .39E-02  '.42E-02 

90. 

.S3E-01 

.63E-01 

-.fc4E-01  -.a4F-01  .66E-02  .67E-32 

time 

T^A3E  0- 

0ISPER3I0N 
HATi^IX 

ESTIMATE  ESTIMATE  ESTIMATE 

EPROft  IN  ERROR  IN  ERR3R  IN 

PSI  TETA  PMI 

0. 

0. 

-.19E-01  -.17E-01  -.23E-01 

10. 

.17244E-04 

-.lCE+00  -.54E«>00  -.75E  + 00 

20. 

.13958E-C5 

-.IBE-Ol  -.29E-01  -.52E-01 

?D. 

.38402E-04 

-.12E-01  .21E-01  .22E-02 

40. 

.16495E-06 

-.lOE-01  .20Er02  -.llE-01 

S3. 

.10833E-0e 

-.1hE-C1  -.24E-01  -.23E-01 
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Table  C-LII-a 


MOI'L  2 
WITH  NOTS? 
KT  s 1 

• PSTT»'JE* 

PP9I0= 

ITE^ITTON 

.FCCCOE+01, 

C . » 

# 1 

.13100E^02f  . 

0 . > 0 a 

15030E*02 

TIME- 

'JELTft  C^) 

HOT  (R) 

OELTA(RO» 

HDT(P.O) 

3. 

.11254E«-02 

.11254E*02 

.92C98E»C1 

.9239824-01 

10. 

.lE401E<-03 

.l£.953E4-02 

.10590E4-02 

.1D546E4-02 

23. 

.535S3£+fll 

.72ie9E+Cl 

-.12143E«-C2 

-.11916E+C2 

30. 

-.2C538E4-C2 

-.113C7E4-02 

-.12595E+C2 

-.11445E4-32 

UO. 

-.32690E»C2 

-.920  48E4-01 

.9e092E«-Cl 

.11574E402 

93. 

-•5C216E*02 

.23144E*01 

-.14107E»C2 

-.94391E4-C1 

TIME 

DELTACAZ.) 

HOT(AZ.) 

02LTA(EL.) 

HDTOEL.) 

0. 

-.15561E-C2 

-.15561E-02 

.902172-03 

.902172-03 

18. 

-.987322-03 

.137  34E-C2 

.806322-04 

.r2932E-a3 

20. 

-.50298E-C2 

1 

.27664E-03 

-.368672-02 

-.133802-02 

30. 

-.75494E-C2 

-.135132-03 

-.386542-02 

.341902-03 

40. 

-.S8394E-02 

.1C2872-02 

-.587102-02 

.435732-03 

90  a 

-.499912-02 

.5C158E-03 

-.815572-02 

.332522-53 

Table  C-LII-b 


MOHPL  2 
MITH  ‘IIISE 
<n  s 1 

EPSTTRUE= 

EPSIO= 

ITERailON 

0c00E*01, 

G.  , 

# 1 

.lQaC0E*02,  .l503aE»02 

0 . * 0 . 

time  ,05LTA  (SPl)  HOTC^ri)  D 

ELTfl(S?2)  H0T(FF2)  0ELTfl(SF3)  M0T(SP3) 

Q.  -•tlE-01 

-.llE-31 

.75E-01 

35E-01  -.30E-01  -.30E-01 

10.  -.32E-01 

.T-^E-Ol 

.16E-C1  -. 

26E-01  .27E-01  -.89E-a2 

2C-.  .16E-01 

-.82E-02 

-.llF-01  -. 

12E-:i  . .ieE-01  .99E-02 

30.  .24E4>00 

.31E-01 

.16E+J0 

i4E«-aa  .4I.E-01  .38c-ai 

40.  .4(»E^30 

.52E-01 

.19E>C3 

IdE^uO  .26E4>00  .19E«00 

50.  .22E4-0G 

.59E-01 

.SOE-OZ  -. 

71E-C1  .SFE^-OO  .30E4-00 

time 

TRftSE  OF 

DISPERSION 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE  ESTIMATE 

ERROR  IN  ERROR  IN 

. TETA  PMI 

0. 

0. 

•SOE^Ol 

.lCE+02  .15E*02 

1 

19. 

.17185E-04 

-.15E+00 

/ 

-.43E»00.  -.5!*E«-a0 

20. 

.13980F-05: 

-.lOE+ao 

-.ISE-Ol  .31E-01 

TO, 

.37915E-06 

-.92E-01 

-.12E+00  -.99E-01 

40. 

.16£11E*06 

-.27E-31 

-.51E+00  -.6lE»aC 

^0. 

.10745E-Q6 

.26E430 

-.69E^00  -.53E^00 
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Table  C-LIII-a 


HOfl=:L  ’ it>*;TT'?UE  = 

with  NTISr  EPSIO= 

a 1 ITE®ATIOM 

.•"ccccE+aif 

.i72C4E*01, 

« 2 

.1J3C0F4-02, 

.lu593Z*C2, 

. 150a0i*02 
.15528E4a2 

TImf 

QrLTA(P) 

HOT{R> 

DELTA  (RO)  . 

HDTCRO) 

G. 

.11254E+02 

.112E4E+a2 

.92090E4-C1 

.92093E<-31 

10. 

.17C36E4-02 

.17CC6E«-C2 

.10654E+C2. 

.109e0E4-02 

20. 

.74676E+01 

.77359E4-01 

-.11812E4-C2 

-.11335'*02 

30. 

-.11363E+C? 

. 119S5E+02 

-.11545E4-C2 

-.11525E+02 

'»0. 

-.12949E«-02  - 

.1^803E«-02 

.10779E*02 

.10597E*02 

50. 

.-.15030E+02 

. 19621E+02 

-.1131dE«-02 

-.11593E402 

time 

DELTA (A7.J 

HOT(A7,) 

OELTACEL.) 

H0T(EL.) 

0. 

-.15551E-02 

.1E561E-02 

.90217E-fl3 

.90217E-03 

10. 

.14844E-02 

.13751E-02 

.7595(iE-C3 

.72953E-03 

20. 

.46129E-03 

.223  02E-03 

-.11S83E-C2 

-.12945E-02 

30. 

.10439E-03 

.22368E-03 

.55423E-03 

.37469E-a3 

40. 

.1096$E-02 

.74669E-03 

.69154E-C3 

.44141E-03 

50. 

.22692E-03 

.58294E-04 

.65257E-C3 

.33587E-53 
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Table  C-LIII-b 


HOn^L  ’ 

WI-^M  MOIS?: 

K1  s X 

EP5ITRUE= 

EOSIO= 

ITF'^ATTON 

.*  CiiOCE+Jl, 
.‘72aitE+01f 
n 2 

.1300GE  + 02,  .ISaOO-E^OE 
.1C693F4-02,  .13523E+02 

TlH!i 

O^LTA  (St^l)  HDT(SPl)  OflLTA  (SF2 ) HOT(SF2)  DELTACSFS)  ^^T(SF3) 

0. 

-.llE-Cl 

-.llE-01 

.?5E-ai 

35E-ai  -.3GE-ai  -.30E-01 

10  . 

.33E-C1 

.44E-ai 

-.18E-C1  -. 

2aE-ai  .lGE-01  .89E-03 

20. 

-.?6E-01 

-.13E-03 

-.A7E-01  -. 

48E-01  .23E-01  .lOE-Ol 

30. 

-.13E-01 

.23E-C1 

.33E-01 

36E-01  .lOE-01  .16E-01 

%0. 

-.65E-01 

-.I'JE-Cl 

-.23E-01  -. 

32E-01  -.24E-01  -.20E-02 

50. 

.37E-01 

. .67E-01 

-.77E-fll  -. 

86E-ai  -.16E-C1  -.32E-02 

• 

TIME 

TRA3E  OF 

DISPERSION 
HATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE  ESTIMATE 

ERROR  IN  PRRDR  IN 

TETA  PHI 

0. 

0. 

•28E«J0 

-.69E^00  r.53E»05 

10. 

.17804E-0U 

7.94E-C1 

-.53E«-aO  -.TVEtOO 

20. 

.14293E-05 

•.17E-C1 

-.32E-01  -.63E-01 

70. 

.38^6CE-0e 

-.13E-01 

.30E-01  .15E-01 

.l7C17F-0f 

•.15E-01 

.25E-01  .24E-01 

50. 

.108i*2E-06 

-.35E-ai 

.39E-03  -.H9E-.C2 
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■Table  C-LIV-a 


MonPL  2 

WITH 

KO  s 1 

EPSITP.lJEs 

EP'^TOs 

ITERATION 

.Eu:5CE+3l, 

.'C3F7E+01, 

# ? 

.1  ]aC0E<>02, 
.9999lr>01, 

.i53oaE+a2 
.1&JC9E  + C2 

TIMP 

^ELTA (’) 

HCT (R) 

OELTACRO) 

9DT(R0) 

0. 

.11254E^02 

.11254Ef02 

.92098E»C1 

.92098E+01 

10. 

.17005E+C2 

.17005E*02 

.1G663E<^C2 

.ia660E+32 

20. 

.73420E4-01 

.774C9E*-C1 

-.11832E«-C2 

-.11832E+a2 

30. 

-.11925E+02 

.11927E+02 

-.11614E4-C2 

-.11514E+Q2 

■40. 

-.14495E+02 

.14496E«-02 

.10642E+C2 

.ia543E+02 

?0. 

-.18602E*02 

.ieP97E+02 

-.11599E*02 

-.11598E+02 

TIHE 

OELTA(A?. ) 

HOT<AZ.> 

OELTA(EL.) 

HOTCEL.) 

0. 

.-.15561E-02 

-.15561E-02 

.90217E-C3 

.90217E-a3 

10. 

. 13.75  7 E- 02 

.17752E-02 

.72944E-03 

.72933E-03 

20. 

.22483E-C3 

.22374E-03 

-.12943E-C2 

-.12949E-32 

30. 

-.21894P-C3 

-.22054E-J3 

.37467E-C3 

.37377E-03 

40. 

.75837E-03 

.7F668E-03 

.44171E-C3 

.44016E-03 

90. 

-.35640E-C4 

-.36474E-34 

.3394&E-03 

.33709E-03 
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Table  C-LIV-l 


morL  2 P'»SITR'JE=  .rCCOCE  + Jl,  .lJOPCE  + 02,  .13000E+.02 

WITH  ^IDI-^E  EPRIOs  .r0353E4-Gl,  .93991E«-C1,  .IsOjSE^CE 


KO 

= 1 

I7PRATI0N 

* 3 

TIME 

HELTA (S^l) 

M3T(S'=’l) 

DELTA  (SF2) 

H0T(SF2) 

DELTA  (SP3)  -«DT(SF3) 

0. 

-.llE-Ol 

-.llE-Ol 

.75E-01 

. 35F-01 

-.30E-01.  -.30E-31 

10. 

.46E-01 

.44E-OI 

-.2SE-01 

-. 25E-01 

.72E-03  .e5E-a3 

20. 

.S3E-C3 

-.15iE-02 

-.i-7E-01 

-.a7E-Cl 

.19E-01  .19E-01 

30. 

.29E-C1 

.2.<iE-01 

.AOE-01 

.40E-C1 

.17E-01  .17E-fll 

40. 

-.73E-fl2 

-.llE-Ol 

-.23E-C1 

r.  23E-01 

.46E-C2  .44E-02 

50. 

.34E-C1 

.63E-01 

-.83E-01 

-.84E-01 

.72E-02  .71E-fl2 

time 

TRACE  OF 

DISPERSION 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
EOROP  IN 
TETA 

ESTIMATE 
ERROR  IN 
PMI 

0. 

0. 

-.35E-01 

.89E-03 

-.49E-02 

10. 

.17799E-04 

-.95E-01 

-.53E»00 

-.74E»aO 

20. 

.14292E-05 

-.18E-01 

-.32E-31 

-.69E-OI 

70. 

.36^59E-06 

-.12E-51 

.21E-01 

.lSE-52 

40. 

.17a23E-06 

-.lOE-Cl 

.44E«03 

-.13E-01 

55. 

.10a43F-06 

-.14E-01 

-.25E-31 

-.30E-01 

Table  C-LV-a 


MOn^’L 

WITw  N^IS 
KD  s 

’ pPSITRnE= 

E fosios 

2 ITERATION 

.‘■COOOE^Ol, 

C.  , 

# 1 

.130CCE*02,  . 

c.  t 0. 

15000E+02 

TIMC 

DELTA  (?) 

• HOT (R) 

OELTA(RD) 

^^T(RO) 

0. 

.11254E+02 

.11254£4-02 

.92098E+C1 

.92098E+01 

13. 

. 16466=“  4-C2 

.1C969E>02 

.10599E+C2 

.10650E+C2 

30. 

.60300E4.31 

.72492E+CI 

-.11955E+02 

-.11319E+32 

30. 

-.15797E4-02  -.11019E  + 02 

-.12060E4-C2 

-.11373E4-02 

40. 

-.26589E+02  -.63362E+C1 

.93172E+C1 

.11530E+02 

SO. 

-.52808E+02 

.11897Ef01 

-.14966EfC2 

-.9740^ 

TJM^ 

DELTA (AT.) 

1 

HOT(AZ.) 

OELTA(EL.) 

HDT(EL.) 

8. 

-..15561E-02 

-.15561E-02 

.90217E-C3 

.90217E-03 

10. 

-.65616E-03 

.13737E-02 

.16728E-C3 

.72962E-03 

. 20. 

-.40r83E-02 

.23331E-03 

-.34265E-02 

-.13042E-02 

33-. 

-.62995E-0? 

-.13694E-03 

-.39089E-C2 

.34678E*03 

40. 

-.54979E-02 

.10231E-C2 

-.61453E-02 

.41026E-03 

SO. 

-.41726E-02 

.47569E-03 

-.d299aE-C2 

.38263E~03 

HOOFL  2 EPSITRUEs  .fCSOOE^-Ol,  .lOOOOE  + 02,  .153a0E^02 

WITM  *niSE  EPSIOs  0.  ,0.  ,0. 

KT  a 2 ITEP.ftTION  # 1 


time 

nELTA  (SFl) 

HOT('?Fl) 

DELTA  (SF2) 

H0T(SF2) 

DELTA (SF3) 

HDT(SF3) 

0. 

-.llE-01 

1 

111 

• 

1 

.75P-01 

. 35F-01 

-.30E-01 

-.30E-31 

10. 

-.54E-01 

.37E-01 

-.E6E-02 

-.27E-01 

.19E-C1 

-.56F-02 

20. 

.13E-02 

-.12E-01 

-.47E-02 

-.76E-C2, 

.19E-01 

.91E-32 

30. 

.24E+00 

.40E-01 

.IfiEfOO 

. 15F+00 

.46E-01 

.42E-01 

40. 

.31E+00 

.36E-Q1 

.15E+00 

. 14E+J0 

.2CE+C0 

.15E+00 

50. 

.24E-i-a0 

.54E-01 

(5^ 

.37E-01 

-.94E-02 

.41E4-0G 

.35E+aO 

TIME 

TRACE  OF 

OISRERSION 
MATRIX 

ESTIMATE 
EPROR  IN 
PSI 

ESTIMATE 
ERROR  IN 

TETA 

ESTIMATE 
ERR3R  IN 
PHI 

0. 

0. 

•SOE^Ol 

.10E«02 

.15E+02 

10. 

•22366E-04 

-.17E+30 

-.SGE^OD 

-.73E*00 

20. 

.19359E-05 

-.lOE+00 

-.16E-01 

.751-02 

30. 

.50420E-06 

-.lOE^OO 

-.ITE^OO 

-.13E^00 

41. 

.22737E-06 

-.56E-01 

-.46E»00 

-.55E+00 

50. 

.1351QE-08 

.22E^30 

-.64E+00 

-.45E4-00 

Table  C-LVI-a 


MOHEL  2 
WITH  MDISF 
KT  s 2 

FPSITPUE* 

FPSIOs 

iteration 

.5CG0CE«-01, 

.47802E<-01, 

» ? 

.1030CE+02, 

.10642F^02, 

.15a:0£*02 
.l';432E  + 02 

TIM- 

3ELTA(R) 

HOKR) 

DELTA  (RO) 

H3T(RD) 

0. 

.11254E+02 

.11254E4-02 

.92093E4-G1 

.92098E4-31 

IG. 

.17028E*C2 

.170o7E«-02 

.10663E+02 

.13563E+02 

20. 

.74213E+C1 

.73389E^01 

-.11821EI-02 

-.11834E+32 

30. 

-.11P37E+C2 

-.11987E+02 

-.11566E+C2 

-.11626E+02 

40. 

-.13292E>C2 

-.14791E+02 

.10777E«-02 

.10306E^32 

BO. 

-.15399E+02 

-.19421E+02 

-.11327E+02 

-.11667E+02 

TIME 

nELTA(A7.) 

H0T(AZ.) 

OELTA(EL.) 

^OT(EL.) 

0. 

-.155S1E-02 

-.15561E-02 

.90217E-G3 

.90217E-03 

10. 

.1457CE-02 

.13751E-02 

.75210E-C3 

.72952E-03 

2G. 

.39347E-03 

.2232CE*33 

-.12124E-02 

-.12946E-02 

30. 

.13473E-04 

-.22336E-03 

.52909E-C3 

.37464E-03 

40. 

.iaOG6E-C2 

.71790E-03 

.66063F-C3 

.‘♦4136E-03 

5C. 

.15857r-03 

-. 54449E-04 

.60615E-03 

.33628E-03 
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MOHEL  2 

WITM  MOISE 

Kl  a 2 

EPSIT3UE= 

19^10= 

ITERATION 

.EC:00E*01,  .lC0CCEf02,  .1300aE«-32 

.»-7802E  + 01f  .10B42E+02,  .15432E+02 
« 2 

TIME 

'•'•LTA(SFl)  MOT(SFl)  C 

ELTA(SF2)  H0T(SF2)  DELTA(SF3)  H0T(SF3) 

0* 

-illE-Ol 

-.llE-01 

.35E-01  .35F-C1  -.3CE-01  -.30E-31 

10  . 

.40E-01 

.44E-C1. 

-.21E-C1  -.28E-U1  .76E-b2  .90E-03 

20. 

-.25E-01 

-.17E-C2 

-.<»9E-ai  -.48E-01  .23E-01  .19E-91 

30  . 

-.72E-C2 

.25E-ai 

.C6E-01  .36E-01  .lOE-01  .16E-01 

40. 

-.!»6E-0l 

-.13E-01 

-.22E-01  -.29F-C1  -.16E-01  .14E-03 

50. 

.34E-01 

.63E-01 

-.74E-01  -.d7E-01  -.18E-01  -.31E-02 

TIME 

TRACE  OF 

0ISPER5I0N 
MATRIX 

ESTIMATE  ESTIMATE  ESTIMATE 

ERROR  IN  ERROR  IN  ERROR  IN 

PSI  TETA  PHI 

0. 

0. 

.22E»00  -.64E+00  -.43E«-00 

- 

10. 

.23100E-04 

-.10E*30  -.62E«-00  -.87E+00 

20. 

.19914E-05 

-.20E-01  -.30E-01  -.5!»E-01 

30. 

.52016E-06 

-.16E-01  .31E-01  .llE-ai 

40. 

.23300F-06 

-.17E-01  .20E-01  .93E-02 

50. 

.13595E-C6 

-.a^^E-fll  -.34E-02  -.23E-01 
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Table  C-LVII-a 


HOnPL  2 PPSITRUEs 

WITH  ‘JOISE  EP5I0= 

KO  = 2 ITERATION 

.!CCC0E*01, 
.FC344E  + 01, 

# 3 

.ig000E4-02, 

.luJL8E+C2, 

.15C00E+02 

.1302jE+02 

TIME 

3ELTA(R) 

HCT (R) 

OELTA(RO) 

HDT(RD) 

g. 

.11254E+C? 

. 11254E+02 

.9209SE+C1 

.92098E+C1 

in. 

.17006E+C2 

'.17CC5E+02 

.1C660E*C2 

.lflo60E+02 

20. 

.73433E»01 

.734C9E»01 

-.11832E*-02 

-.11832E+02 

30. 

-.11922E+02 

-4  11929E4-02 

-.11614E«-C2 

-.11514E4-02 

<»0. 

-.14484E+P2 

-.1L5Q5E+02 

.10644E4-C2 

.10642E+02 

50. 

-.10566E+C2 

-.lfc62lE+02 

-.11595E+C2 

-.11600E+02 

TIHE 

OELTA(A^. ) 

HOT(AZ.) 

OELTACEL.) 

^^T^EL.) 

0. 

-,15561E-C2 

-.1F561E-02 

.90217E-03 

.30217E-a3 

10. 

.13776E-C2 

.13752E-02 

.72999E-03 

.72933E-03 

■ 20. 

•22894E-C3 

.22173E-03 

-.12924E-02 

-.12949E-02 

30. 

-.21311E-03 

-.22061E-03 

.379C6E-C3 

.37379E-03 

40. 

.76432E-03 

.7F644E-03 

.44855E-C3 

.44019E-03 

50. 

-.31714E-04 

-.3f973E-04 

.34841E-03 

.33704E-33 

175 


Table  C-LVII- 


MOP?:!  2 

WITH  HOISE 

KP  s 2 

EF5ITRUE= 

EPSin= 

ITERATION 

.EOOOCE+01, 
.E0344E+01, 
» 3 

.13000E+02,  .150001*02 

.100C8E*02f  .15o20E*02 

TIME  PELTACS^l)  H3T(SP1)  QELTA  ($^2)  H0T(TF2)  DELTA  (SF3)  HOT(SF2) 

0.  -.IIE-Ol 

-.llE-01 

.35E-01 

35E-01  -.3CE-01  -.30E-31 

10.  .45E-01 

.44E-01 

-.28E-C1  -. 

28E-C1  .72E-03  .85E-C3 

20.  •66E“03 

-.16E-02 

-.i^TE-Ol  -. 

47E-01  .19E-01  . .19E-D1 

30.  .28E-01 

.26E-01 

.*!0E-01 

40E-01  .17E-01  .17E-01 

40.  -.39E-02 

f 

-.liE-01 

-.23E-C1  -. 

24E-01  . .44E-02  .43E-02 

50.  .S4E-01 

.63E-01 

-.e3E-01  -. 

84E-01  .69E-02  .67E-02 

time 

TRACE  OF 

DISPERSION 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE  ESTIMATE 

ERROR  IN  ERROR  IN 

TETA  PHI 

0. 

0. 

^.34E-pl 

-.84E-02  -.20E-01 

10. 

.23397E-04 

-.lOE+aO 

-.62E*00  -.88E*00 

20. 

.19913E-05 

-.21E-01 

-.31E-01  -.67E-01 

30. 

.52024E-C6 

-.16E-0l‘ 

.20E-01  -.46F-02 

40. 

.23308E-06 

-.14E-01 

.13E-02  -.13E-01 

50. 

.13603E-06 

-.18E-01 

-.28E-01  -.37E-01 
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Table  C-LVIII-a 


MO^PL 
MTTM  'n 
K1  s 

2 

IS£ 

3 

EPSITRUEs 

EP3IO= 

ITFPftTION 

.rooooEtoi, 

0.  , 

♦ 1 

.lG033E^C2f  . 

0 . 9 0. 

15300E<<02 

TIME 

DELTft(^) 

HCT(R) 

OELTA(RO) 

HDT(RO) 

c. 

.11254E*0? 

.11254E+02 

.92099E>C1 

.92099E+01 

10. 

.164a3E+C2 

.lf954E*02 

.1059ie+02 

.1054624-02 

■ 20. 

.52964E+ai 

.72281E+01 

-.121&3E<-e2 

-.11314ET02 

30. 

-.21135E+02 

.112(>8E402 

-.12677E+C2 

-.11436E4-02 

40. 

-.34434E+02 

. 89399E+01 

.96501E>01 

.11515E4-02 

53. 

-.53705E«-02 

.33074E+01 

-.14235E+C2 

-.93958E+D1 

TIME 

OELTA(A7.) 

HOT(A2.) 

OELTA(EL.) 

HDT(EL.) 

0. 

-.1555 IE- 02 

-.1F561E-02 

.90217E-r03 

.90217E-03 

10. 

-.981902-03 

.13734E-02 

.52075E-04 

.72927E-03 

22. 

-.49796E-02 

.27798E-03 

-.37717E-C2 

-.13081E-02 

30. 

-.74098E-02 

-.13139E-03 

-.39825E-C2 

.34216E-03 

40. 

-.6518&E-02 

.1C350E-02 

-.39929E-C2 

.40551E-03 

50. 

-.47950E-02 

.51443E-03 

-.82747E-02 

.383122-03 
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Table  C- 


lOOFL  2 

WITM  MOISE 

O = 3 

EPSITRUE= 

FPSIOs 

ITERATION 

GCQCE^C1> 

C.  t 

* 1 

.1C30CF4^G2»  .15030E4'02 

0 . f 0. 

TIM- 

nFLT4(SPl) 

HDT(SFl)  0FLTA(SF2)  H0T(SF2)  DELTA (SF3)  H0T(SP3I 

0. 

-.llE-Ol 

-.IIE-Jl 

.cSE-Cl 

35E-01  -.3CE-01  -.30E-01 

10. 

-.35E-C1 

.3<*E-u1 

.12E-01  -. 

26F-01  .26E-01  -.89E-02 

20. 

.14E-0.1 

-.32E-02 

-.96E-G2  -. 

llE-Cl  .17E-01  .lOE-01 

30. 

.24E+00 

.32F-01 

.1&E4-00 

14E4-00  .46E-01  .39E-01 

40. 

.'♦4E*00 

.62E-01 

.18E-»0e  '. 

18E+30  .2PE+00  ■.19E<>00 

50. 

.23E4^00 

.69E-01 

-.e8E-03  -. 

25E-01  .35E«-0G  •30E4^00 

TIME  tra:e  of 

■DISPERSION 

H4TRIX 

EStiMATE 
ERROR  IN 
PSI 

ESTIMATE  ESTIMATE 

ERROR  IN  ERROR  IN 

TETA  *>MI 

0. 

0. 

•SOE^Ol 

.10E»02  .15E»02 

10. 

.l'^n87Er04 

-.15E+30 

-.43E«a0  -.5!»E^30 

20. 

.13S68E-05 

-.lCE+30 

-.17E-fll  .2TE-01 

33. 

.38222E-06 

-.91E-01 

-.13EfOO  -.11E«-00 

43. 

.16310E-06 

-.23E-01 

-.52E«>0C  -.63E+00 

• 

so. 

.10811E-06 

4 

.31E4-30 

-.70E*00  -.52E«^00 

L 
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Moort 

WITH  MOIS 
KO  - 

2 EPSITOUE^ 

E EP^IOs 

3 ITEi^&TION 

.^’COCCE'^Ol, 

.i*6933E*01, 

* 2 

.ICOOOE^OZj 

.10701E4>G2, 

.15000E4-02 

.15523E4>C2 

TTMC 

OELTfti?) 

HCT  CR) 

OELTA(RO) 

H3TCRD) 

0. 

.11254E+02 

.11254£^02 

.92098E-»01 

.92098E<fOl 

10, 

.17036E+02 

.17006E+02 

.10e64E>C2 

.13S60£<»32 

20. 

.747igE*Cl 

.73355E+31 

-.11810E+02 

-.11835E+02 

30. 

.-.11333E*02  -.119S3E<-02 

-.11541E+02 

-.ll&25E+a2 

tc. 

-.12853E+U2  -.lt813E+02 

.1G76&E4-02 

.10595E+1)2 

BO. 

-.148S1E+02  -.1P656E+02 

-.1130ftE*02 

-.11S94E4-02 

TIME 

OELTA(A2.) 

HOT(AZ.) 

OELTA(EL.) 

HOT(EL.) 

0. 

-.15561E-02 

-.15561E-C2 

.90217E-C3 

.90217E-33 

10. 

.14842E-02 

.12751E-02 

.76083E-03 

.72954E-03 

20  . 

.45839E-03 

.22297E-03 

-.11847E-02 

-.12945E-02 

.30.- 

.97910E-04 

-.22384E-03 

.55859E-03 

.37470E-03 

43. 

.10S69E-02 

.69521E-03 

.44140E>03 

50. 

.21817£^03 

-.5a858E-04 

.65461E-03 

.33587E-03 

Table  C-LIX- 


non 

'L  2 

EPSITPUE= 

.*'OCOO£  + blf  .loOC 

CE4-02,  .150 

JJE^02 

WITH  NOISE 
•(0  = 3 

Et>SIOs 

ITERATION 

.t6933E*0i,  .10701E+02,  .15523E»02 

# ? 

TIME 

OELTA (SFl) 

HnT(S=^l) 

OELTA  (S=’2) 

H0T(SF2) 

delta (SF3) 

H0T(SF3) 

0. 

-.llE-Ol  • 

-.llE-01 

.75E-01 

.35E-01 

-.30E-01 

-.30E-01 

10. 

.31E-01 

.4-E-Ol 

-.19E-01 

-. 26E-01 

.lOE-ai 

.90E-33 

20. 

-.23E-01 

-.13E-02 

-.*.7E-C1 

-.48E-C1 

.23E-01 

.19E-01 

30. 

-.ISE-fll 

.25E-01 

.33E-01 

.35E-C1 

.lOE-Ol 

.16E-31 

<»0  . 

-.39E-01 

-.13E-C1 

-.22E-01 

-.32E-01 

-.24E-01 

-.20E-32 

SO. 

.35E-01 

.63E-01 

-.76E-01 

-.86E-01 

-.16E-01 

-.34E-02 

TIME 

TRACE  OF 

OIS»ERSION 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
ERROR  IN 
TETA 

ESTIMATE 
ER*>0R  IN 
PHI 

0. 

0. 

• 31E4-ob 

-.7CE+00 

-.52E+00 

10. 

.17'^21E-D4 

-.94E-01 

-.53E+00 

-.75£»00 

20. 

.14284E-0'^ 

-.16E-01 

-.29E-01 

-.60E-01 

30. 

.39fl72E-06 

-.12E-01 

.31E-ai 

.15E-01 

43. 

.17211E-ce 

-.I'SE-Ol 

.26E*31 

.25E-01 

SO. 

.10989E-fl6. 

y 

-.36E-01 

.S5E-03 

-.54E-02 
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Table  C-LX-a 


HOn'L  2 
WITH  NIISE 
O = 3 

E»SITRyEs 

EP«JI0= 

iteration 

.eOOOCE+Olf 
.f  0362E<-01f 

i 7 

.10]00E4-0?f 

.99992E+01f 

.19000E^02 
. 13003E^  02 

TIHE 

DELTA (R) 

HOT  (R) 

DELTA  (RD) 

HDT(RO) 

3. 

.11254E^02 

. 11254E4-Q2 

.92098E4-C1 

.92398E*01 

13. 

.17305E+02 

.170e5E»02 

.10660E«02 

.10S60E-«-C2 

20. 

.73420E+C1 

.73409E>01 

-.11832E*C2 

-.11832E»02 

30.- 

-.11924E+C? 

.11927EV02 

. -.11614E+02 

-.11d14E+C2 

uo. 

-.14495E+02 

.1<-497E*J2 

.10642E4-C2 

.iaS43E-^32 

^0. 

-.186a2E*02 

.lf596E4>02 

-.11599E*-02 

-.11598E<-02 

TIME 

0ELTA(A7. ) 

HOT(AZ.) 

DELTA(EL.) 

HOT(EL.) 

0. 

-.155&1E-02 

-.15561E-C2 

.90217E-C3 

.90217E-03 

10. 

.13757E-02 

.17752E-02 

.72947E-C3 

.72933E-03 

20. 

.22497E-C3 

.22374E-03 

. -.12944E-02 

-.12949E-02 

3C. 

-.21876E-03 

-.22C54E-  33 

.37484E-G3 

.37377E-03 

49. 

.75853E-C3 

.756  67  £-0  3 

.44196E'03 

.4**016E”0  3 

53.  ■ 

-.35575E-04 

-.3C493E-04' 

.33981E-03 

.33708E-03 

Table  C-LX-b 


M30^L  2 

WITH  ‘niSE 

KT  a 3 

EP3ITP|JE= 

EB^rOa 

ITERATION 

.50:0CE+01,  .1C10CE+02,  .15030E+02 
.‘0362E+01,  .9a9‘}2=>01,  .15J03E  + 02 

# 3 

TIHE 

OELTft{S'‘l) 

HDTCSPl) 

DELTA  (SF2) 

H0T(SF2) 

DELTA  {SF3) 

HOT(SF3) 

0* 

-.llE^Ol 

-.llE-01 

.75E-01 

. 35E-01 

-.30E-01 

-.30E-(Il 

10. 

.46E-01 

.4hE-01 

-.2dE-01 

-.26E-01 

.72E-03 

.a5E>03 

20. 

.O3E-03 

-.15E-02 

-.i.TE-ai 

-.47E-01 

.19E-01 

.19E-01 

30. 

.29E-01 

.26E-01  . 

.AOE-01 

.40E-01 

.17E-01 

.17E-31 

<»0. 

-.’3E-D2 

-.llE-01 

-.23E-C1  • 

-.23F-01 

.4CE*02 

.44E-32 

50. 

.S4E-01 

.63E-01 

-.e3E-01 

-.  84E-01 

.72E-fl2 

.71E-32 

TIHE 

TRACE  OF 

MSPERSION 
MATRIX 

ESTIMATE 
ERROR  IN 
PSI 

ESTIMATE 
ERROR  IN 
TETA 

ESTIMATE 
ERROR  IN 
»HI 

9. 

0. 

-.36E-01 

.85E-03 

M 

0 

1 

III 

u\ 

• 

1 

10. 

.l7’16E-04 

-.95E-01 

-.53Et00 

-.75E*00 

20. 

.14284E-09 

-.18E-01 

-.30E-01 

-.63E-01 

30. 

.39081E-06 

-.12E-01 

.21F-01 

.22E-02 

40. 

.17219E-05 

-.lOE-01 

.82E-03 

-.13E-01 

FO. 

.10896E-06 

.-.1hE-01 

-■.25E-01 

-.30E-01 
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Computer  Flowcharts  and  Programs 

This  Appendix  contains  the  computer  listing  and  an 
abbreviated  flowchart  of  the  programs  utilized  In  the  study. 
The  main  program,  SIMUL  1 or  2,  Initializes  the  misalign- 
ment angles  and  the  appropriate  transformation  matrix,  the 
random  number  generator,  the  position,  velocity  and  specific 
forces  and  evaluates  the  states  for  the  Truth  model.  Using 
subroutine  MEASURE  the  output  vector  Is  then  generated, 
noise  Is  added  to  It  (using  subroutine  NOIZE)  and  It  Is 
recorded  on  Tape  5. 

Model  1 takes  the  specific  force  values  from  Tape  5 
and  uses  them  as  Inputs  to  the  modeL  An  estimated  output 

A 

vector  Is  then  generated  (Rdr)  and  compared  to  the  true 
one  (Rdr)  read  from  Tape  5 In  subroutine  INFOMAT.  The 
state  sensitivities  and  the  Information  matrix  components 
are  generated  In  the  main  program  using  the  Integration 
routine  EULINT.  Then,  using  the  output  sensitivities 
generated  In  subroutine  SENSOUT  and  the  output  differences 
(Dout)  the  gradient  vector  Is  generated  and  the  optimal 
misalignment  angles  correction  Is  calculated. 

Model  2 Is  very  similar  except  for  the  fact  that  It 

A, 

generates  estimated  specific  forces  (SF)  Itself  and  uses 
all  the  values  from  Tape  5 as  true  output  values  to  be  com- 
pared to  the  estimated  ones  that  It  evaluates. 
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The  flowcharts  that  follow  are  for  the  Truth  Model, 
Model  1 and  Model  2.  The  listings  are  of  the  programs 
SIMUL  1 (Truth  Model  and  Model  1)  and  SIMUL  2 (Truth  Model 
and  Model  2) . 


< ‘i 


i' 

( 


i 
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♦ 

To  Model  1 
or  Model  2 


Fig.  7 Flow  Chart:  Truth  Model 
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Fig.  8 Flow  Chart:  Model  1 
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Fig.  9 Flow  Chart:  Model  2 
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P’OGRAI  SIMULI  (I‘|PU'^,Oli7PUT  = 10C?3,TiPE5=i:  j23,TAPE13  = 0UTP’JT) 
SIMJL  IS  a SI-1'JLaTIO»  OP  THE  TPfiCKI'jr.  ANO  CONT^TL  OF 

•AH  aiP-TO-r.^O'jm  misSILl  USIfP  haxihijh  likelihood  ‘^STIHATION 
•OF  the  THP.E;  AHOLFS  ‘^E^PESEN'' I NG  ITS  INITIAL  HISALIGNHE.'JT . 


COlHON/TI^EP/ftOT.TF.nFtT 
CO  1HON/E=>SIl  ON/OOI  ,-fETa,Pt-I 
C0'1H0H/E®5'‘’U-/°STT,  fSTtT  ,?HIT 
C01MO*4/£  = FIO/"SIO,TFTAO,FHIP 
nHMO'»/:ONT=‘OL/‘fO,  BETAC.PELTAC 
CO<M0M'0Y-ia'^IC/'’ETA,D:L*A  ,n,aLPHA,L 
CO-IMOM/MO^TMAl/X,  Y,7,  vy,VY,\/Z,  V 
COIMOMXINTTTAL/XO,  YC,70,'/v0,VV0,VZ0 
C0^H0*l7SE‘ISTa-^/SE3SP(7,I)  ,3EPPV(3,3) 

CO'IHON'SEVFSO-’^'oEPSdt’)  ,3<DEPS(1,~)  ,SpSPEPS  (1,3)  ,3TE=EPS(1  , I) 

COiHOH/HOI'^VA%/''N,?,ON,  FSIKN,TETP^',F1N,F2^^C3^J 

Cn'1'10N/INF''-'aT/H(3, 3)  , W (3,1)  , DM  (3, 3)  , OH  (3,  1) 
rOMMO’l/OLA'K/OMAd,’)  ,r.tMa(7,3)  .GAME  (3,3),SF(7,1)  ,GA3(3,  I) , 
KLTFT(3,1)  ,0)7  (7 ,1)  ,C’JTN  (A, 4)  ,P'JT^U  (7 , 1 ) ,F3  , ACC  ( 3,  1)  , SO  JT  EPS  ( 4 , 3 ) 
COMHON/LOGi:/  lOOEl 
LOGICA.  MO'^El 

OIMENStON  U(3o)  ,H!<APEA  (18)  ,'*1  (3,3)  ,TYiM£  (C)  , OELTO'IT(  18 , 4)  .HOTOUK 
<13,4)  ,1^0(15)  tOPST  (13)  ,rTETA(16)  ,DPHI  (If  ),PSI=  (3)  ,TETA=>  ( 3)  , PHIP 
<(3) , DOJT (-,1) ,HPT (t) ,TAvlCR(4,1)  ,EPS{3,1) 

REAL  M,LIFT,L,MT 


•initialization  of  the  PArOOM  NOHOER  GEMEPATOR  FOR  KOISE  GENERATION. 

PRINT(1S,93) 

J»=l 

CALL  RANSFT(jj) 

T=3. 

0PRNT=5. 

PRINT*, "♦♦•TP'JTh  mopfL  *••" 

M00E1=. FALSE. 

•INITIALIZATION  OF  THE  MISALIGNMENT  Af(GLES  WITH  OALHES  ASSJMEO  TO  BE 
•TRUE, 

«»ST*PSIT 

teta»tftat 

PHI*PHIT 

ftPSI=ATETe=aPHI=0. 

* »»«4«««***«**.***4«*«*»«**«««* 

•OEFINITION  0^  the  MISALIGNMEf.T  ANGLES  TRANSFORMATION  MATRIX. 

• 1.  -PSI  TFTA 

♦ CMAr  osr  1.  -PHI 

• -TETA  PHI  1. 


CHA(1,1) =CMA (2, 2) =CHA (3,Z)=1. 
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rMa«e,i)»P5i 
C*«>n,l)  s-T:  T4 


»)»-:: "ift  (2,1) 
(;‘<i(i,?)»-OMa(i,i) 
CHAC2,3) a-r-s (3,2) 


•INlTTftUTZATION  0^  POSITION,  yfL  OCITY  , «N0  fPr-ITPIC  PfP^CF. 

XaXO 

YaYO 

7aT0 

vxayxo 

VVaVYO 

v’syzo 

VaSlRKtfX^VX+VY^VY^VZ*  V7) 

SP(1,1)=C. 

SP(2,1) =0. 

SP(1,1)=0. 

« •*«*♦*♦♦♦♦♦♦•*•♦*♦♦♦*******♦♦♦ 

•eVAL'.'ATION  3P  TH?  '/ALMC  OF  THE  STATES  FOE  THE  TEOTH  MODEL  . 

10  CALL  MFASl'PE 

M?TTE(5)T,  (Ol)T(I,l)  ,1  = 1,7)  • . 

CALL  CONTROL 

roa-i. 

call  dynamic 

FOaO  . 

CALL  nominal 
CALL  STpFORCE 

20  lF(A9S(r-0PPNT) .LT.1.£-C6)60  TO  40 
30  T.T+OT 

1F(T.LE.TP)G0  TO  10 
);0  TO  30 

40  PRINT (10, PR)  KT, RETA,0£LTA ,C, ALPHA ,L , X , Y, Z, V, VX, VY, 7Z , T , OETAC, 

tOELTAC,S®’(l,i:  ,3'^  (2,1)  .'"F  (5,  l ) ,OJT  ( 1 , 1)  ,OJT  (2,1)  ,0)1(3,!  ) ,0iJT  (<,,1) 
I, ACC (1,1) ,420(2,1) , ACC (2,1) 

PRINT (10, 70) T, (OUT (1,1) ,1=1,7) 

0ORNT=3PRHT*0°RT 
GO  TO  30 
SO  REMIM3  5 

PRINT*, ••♦**‘»n3EL  I***" 

M01El».TRUr. 

PRINT*,  “MOO£l=”,MOOEl 

PRIsPSIO 

TETA=TETAO 

PHI=PHIO 

00  110  NN=1,3 

NsIN 

T=3. 

OPRNT=0. 


♦INTTTALIZATION  0^  ■^HE  MISALIGNMENT  ANGLES  WITH  FIRST  ESTIMATED 
♦NOMINAL  VALUES. 

PSI«PSI*APOI/13GO 

TETAaTETA*4TETA/l  :00 

PMraPHI*APHI/l 02 j 

PSIP(M)«1G00*"SI 

TETAP(N) =1300*TT*A 

PH!P(N)slCOC'RHI 

CMl(l,l)aCMA(2,2)=CMA(3,3)=l. 

CMl(2,l)s®SI 

CM4(3,1)’-TETA 

CMA(3,2)*PHT 

CM\ (1.2) a>rHA  <2 ,1) 
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=-C'iA(3,l) 
rii  C2,?)«-C1A(7,2) 

•iniTIALI^ATias  OP  »0*:rTION,VFLOClTY, SPECIF!.:  FO:?CE,AEPOnvHAMIC 
•VAL'.IES.IMFOPMATION  AN'T  OISPEFSION  matrix  ELe“E»4TS  ANO  T^A^F, 
•an:  sensitivities. 


U(1)*X3 
*IC»)  *Y3 
Ij(3>=20 
0(i»)»VX3 
U{5)sVY3 
U(5)rVY3 
UCi) sVTO 
SPd.DsO. 

SP(2,I)=0. 

SP(3,l)sO. 

BETAsO. 

n"LTA»0, 

0»1 . 

ALPNAaO. 

L*3. 

00  55  1=1,3 
00  35  J=l,3 
«P»SP(I,J)=C. 

S"»3V(I, J)=0. 

M(I,J)sO. 

HTCI,JJ»0. 

55  CONTINUE 

00  60  I=r,35 

U(I) =0. 

.50  CONTINUE 

0'»TN(1,1).=1./('>M*P.N) 
0*J’’N<2,2)=l./(pnM«pnN) 
0UrN(3,3)=l./('‘OI'?N-3SIFM) 
0'JTM(h,i,)=1./{TETPN*TETPN) 
0’ITh<i,2)=o  ITN(  1,3)  =OUTr  (!,».)  =0. 
0UTN(2,1)=0IITN(2,  5)  =CUTV  ( 2, 4)  =0 . 
ours  (3,1)  =OUT’l  ( ?,  2)  =OUT^  { 3,  4)  =0  . 
0I)TN(4,1)=0UTm(4,2)  =OUTN(4,3)=a. 

00  100  K'<=1,5C01 
REA3(5)T,  (OUT'^Ud)  ,1  = 1,7) 

STATES  DEFINITION 


POSITION! (1-3) 

U(1)=X,  U(2)=Y,  U(3)=7, 

VELOCITY! (4-3) 

U(4)=VX,  '.)(5)=VY,  U(6)=VZ, 

POSITION  SEN'^ITIVITY  ! (■'-15) 

U(T)aX/PSI,  U(3)=X/rETA,  IM9)=X/PHI, 
!»(l3)=Y/oSI,  U (11)  =Y/TETA,  !)  (1?  )=Y/PMI  , 
II{13)=2/PSI,  U(l-)  =Z/T:TA,  U(15)=Z/PHI, 

VELOCITY  SENSITIVITY) (16-24) 

U(15)=VX/“3!,  U(  17)=VX/TETA,  U( 10) = VX/PH I , 
*){19)=VY/oPI,  l!(?C)=VY/TFT  A,  U ( 21 ) = VT/PMI  , 
U(!2)=VZ/PSI,  U(23) =VZ/TcTA,  U(24) = VZ/PHI , 

IN=0<vMATI0N  MATRIX!  (2F-33) 

0125)  ll(?d)  U(71) 

U(23)  U(23)  0(32) 

0(2Z)  U(TO)  0(33) 

TRANSPOSE  OP  SPAOIEMT  VECTOR !( 34-36) 

M=  0(34)  0(30)  0(36) 

X«U(l) 

Y«J(2) 
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7a'JI3) 

VX3U(i») 

vy=U(5) 

V7sU(%) 


•'JSIMG  THE  RECEIVED  ’JeECIPIC  FORCE  4S  INPUTS  TO  HOOEL  1. 


00  70  1=1,3 
SFdtDsOU'RlMI^i,) 
ro  CONTINUE 

CALL  MEASURE 
00  3C  1=1,3 
00  30  J»l,3 
SE^S»(I, J)=U(3*I* J*3) 

SF»SV(I,  J)=U(3*I*JH2) 

30  CONTINUE 

I^(  («-l)  -10  0 3*  ( (<K-1)  /10:0>  .EO.O)PPINT  (1C  ,87)  ( (SE=>SP  ( I , J) , J = 1 , 3)  , 
ni»l,3)  , ( (SE’S'/d,  J)  ,J=1,3)  ,1  = 1,3) 

CA’-L  SENSP'JT 
CALL  IN-O^AT 
00  63  1=1,4 

. nO)T<T,l)=OUTRUd,l)-OUTd,l) 

6?  CONTINUE 

F®?(1,1) =PSIT-oSI 
':p3(2,1)  =TETAT-TETA 
E'»S(3,l)=PHtT-3HI 

CALL  NATNiSOUTEPS, EPS, TAYLOR, 4, 3,1) 
no  75  1=1,4 

MOT  ( I)  =OOUTd,l) -TAYLOR  (1,1) 

’5  CONTINUE 
CQaO. 
tC=36 

CALL  EULINTdJ.X,  .01) 

IF(  («-l)  -13C?*  ( (KK-1)  /lOCO)  .EQ,0)PPINT(10,81)  OOUT,HOT 
IF(  («-l)  -loco*  ( (KK-l)  /lOCO)  .EQ.u  )PRINT  ( 1C  , 79)  T , ( O'JTRJ  ( I)  ,1  = 1,7) 
1F((K<-1) -103  3*  (CKK-D/IOGO)  ,NZ.O)GO  TO  83 
TYNE( (<K-1)/130C*1)=(KK-1)/100. 

00  82  1=1,4 

OELTOUT(  (5*  (N-1  )♦  (KK-D/lOCC  + l)  ,I)=OOUT(1, 1) 

Hn^OUT((S*(N-l) *( XK-1) /;C03+1) ,1) =HOT (I) 

32  CONTINUE 

33  no  93  J»l,3 
00  90  1=1,3 

»*d,  J)  »)(21*I>3*J) 

90  CONTINUE 

T-(X'<.E1.1)30  TO  toe 

IF(  (KK-D-ICO:*  ( (:<K-l) /ICCO)  .NE.OGO  TO  100 
CALL  LINV2F(N,  ’ ,3  , “T  , 1 C ,W‘^APEA  , lER) 

709(6* (N-1) ♦(<K-1)/130  0*1  )=NI  (1,1)*“I  (?,2)*MI(3,3) 

“PINT  (10, 7 A)  T’TCV*  (N-1)  ♦(i«-l)/lJaO*l) 

A'»SI*(NI  (1,1)*'J  (3i.)  tNI C,  2)*'I(3E)  ♦MI(l,3)*U(3t)  )*1300 

ATffTA={NI  (2,1)*1'{7‘*)»NI  (2,2)*U(35)*MI  {3,3)*U(3a))*100  3 

A»NI=(MI  (t,i)*M(7,)  tMi  (?,2)*U(35)  *'11  ( 3,  3 ) *U  ( 36)  ) *1 JSO 

PPSI  ( j*(N-l)  ♦(<<-!) /lCCi-*l)  = (PSIT -PSD*  lOCO -A  PSI 

P7PTA(3*  (N-1)  *(  <<-1)  / lOC  OM)  =(TETAT-TETA)»130C-ATEYA 

OPHI  (6*(M-l)  ♦(XK-l)  /1!;CC*1)  = (PHIT-PHI)*1C0Q-APHI 

PRINT  (10, 92)  <3,  N,OPSI  (6*  ( N-l)  ♦ («-!)/ 13  CO*t)  ,PTETA(3*  (N-D* 

K («-i)/ioao*i)  ,npm  (6*  (n-d  ♦(<k-i)/io  )o*i) 

103  CONTINUE 
OEM  I NO  3 
lie  CONTINUE 

ps:tp=iooc*psit 
tptATP=100C*TETAT 
PMlT»»10a0*PMTT 
no  13  N«l,3 

P»tNT(lC,l)PSTTO,TETATP,PHlTP,PSIP(N) ,TrTAP(N) ,PHI"(N)  ,N 
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L 


1 PO’^aTC*!  MOOSL  l**t^>X,"EPSITRUC  = **»2(Cl2.‘5»"»''»,‘l».5,/3X, 

NOI'£",:X,"TPriO=  2<£l3.‘i, ••»••)  »f:i2. 5, /3X,“<T  = 3", 

X*!Xi~IT'i»'iriON  * •Ml,///) 

P'’.I'IT(10,3) 

2 '■0-?'1(lT(UX,*’TT'^(-",  ='X,“nELTA(«<)**,rx,’*H0T{P)”,6X,**0ELn(R0)-, 
X^X,"HOT{^n) -/) 

no  4 1=1,6 

“"TNT  { 1C,  3)  TY  JEd)  ,PPUTCUT(  (6*  (N-l ) ♦!  > , 1 ) , MOTOUT  ( (6*  (N-1)  ♦!)  ,1)  , 
Xn=-!.TO’JT<  (^•(r4-l)  VI)  ,2)  ,vOTOUT(  (6*{N-l)  VI)  ,2) 

4 nO'ITIN'lE 

3 FOP*1ftT(4X,r4.i,-X,2(£l2.5,2X),2(2X,El2.5)/) 

»»?tNT(10,0) 

« FO<M4T(**0’’,3X,"TI  •t£",5X,“CELTA(AZ.)  “,5X,"H3T(AZ.)”,2<, 

X-ULTA  <rL.)**,5X,’*MOTf£L.)",/) 

on  6 1=1,6 

P‘*If4TC10,?)TYMF(I)  ,rcLTCUT((Ov(N-l)  vl ) ,? ) , HOTOUT  ( (6*  (rJ-1 ) vl)  , 3)  , 
XOELTOUK  (evC'J-DvI),^)  ,HOTOUT(  (6*  (H-t)  vl),4) 

6 CO'ITIMUE 
9RINT(10,.11) 

11  FOJHAT  (6X,“TI-E",3X,”T9;CE  0F*‘,6X,Z  (AMFr;TIHATE,4X)/15X, 

X-irSP£‘’SrO*4",iX,3(aHEiiRCP  IN,^X)/l7X,"'tAT9rx",10X,">SI", 
<9X,-TETA**,9X,**PMI"/) 
on  12  1=1,5 

9'»Tf)T<10,13)  TY^Ed)  ,TS;0(&*(M-1)  vl ) ,0PSI(6v  (N-1 ) vl)  jDTETA 
X(6*(N-1)  vI)  ,OPHI(r,*{N-l)vl) 

1?  CONTIMDE 

13  FO’'1AT(3X,F4.C,5X,£12.5,3(3X,E9.2)/)- 

15  COSTIflUE 

7=  PO’'1AT(lX,’*TPn=**,-l?,5/) 

i’’  F0’MAT{11X,3(E9.2,2X)/ZX,"SE°SP=  ",  3 (E9 .2 , 2X) /IIX,  3 ( E9 . 2,2X) 

X//11X,  3(E9.2,?X)/3X,"SEPS'y=  ",  3 ( £9. 2 ,2X)  / IIX,  3 (E9.  2 ,2X)  //) 

79  EO'i'IAT  (1X,5H0UT‘?1J=,F6.3,4  (ZX , £9 . 2 ) /1 3 X , 3 (2X  , £9 .2) // ) 

92  FO?HAT{lX,^HPELE'’nt,Ii,2X,H,x£i2.5/) 

91  P92»1AT(1X,"00'JT=",4(E10.3,2X)/1X,‘*H07  =",4(E10. 3,2X) /) 

93  F9R**AT(5X,”'<0",oX,”e£rA",f.X,"3ELTA",SX,"P",8X,"ALPHA",3X,"L”,// 
X,3X,"X",  lCX,*‘Y",iax,"Z",lCX,"Y",10X,"VX",gX,"VY",9X,"VZ",//, 
<5X,"T”,3X,"9rTAC”,6X,"DfLTAC",l7X,"?Fl",8X,"S«‘2",9X,"S-3",/./, 
X‘;X,"R",9X,"R00T",7X,”PSIR",7X,"TE7R",7X,*‘ACC1",7X,"A332",7X, 
t"ACC3",//) 

99  FORMAT{5X,I1,SX,9(E10.3,1X)/1X,7(E1C.3,1X) /IX ,F6. 3, 5X  , 2 ( FIO.  3 , IX)  , 
X11X,3(E1G.3,1X) /1X,7(E1C.2,1X)//) 

STOP 

F^f3 


PLOCK  DATA 
REAL  L,*) 

COilOf^/TIMER/T.OT.TF.OPFT 
r9AM0N/cPET-'.UE/?RIT,T£T;T,PHIT 
r3X.>fO*f/EPSin/°9in,T'=’TAO,FHO 
CO  «'10'J/90N’’R0U/xn,SFTAC,nELTAC 
CO'1'1ON/0YMfl'n3/'’£rA,9ELTA,O,  ALPHA,! 

COlHOM/I'ilTT  AL/XO,  Yr.,7O,VX0,VY0,V20 
CO)'iON/3"'l<;7AT/SE’SF(3,7)  ,SEPSV(3,3) 
C0'>90N/*J0I':\/A.?/R:i,Prv,OFrs>N  ,TETRr),=‘lN,F2N,F3N 
fni90H/:NF0HAT/M(3, 3) , H ( 3 , 1) , DM ( 3 , 3 ) , UH < 3, 1 ) 

HATA  OT,TF,npoT/.ci  , = 0 . ,1C./ 

OATA  PSIT,TETAT ,PHIT/l.E-C3,2.E-j3,3.E-03/ 

OATA  BSIO,TFTAO,PHio/3vO./ 

OATA  <0/3/ 

OATA  9ETA, TELIA ,0 , ALPHA ,L/5*fl  . / 

PATA  xn,YO,-'p,VXOi  VYO,  V70/2*10  0C.,ieC.,2C33  .,  1500.,10./ 
PATA  SE?SO,SE’9V/13*o./ 

PAT  A RN,ROM,P3IR'>,TETHN,F1N,F2N,F3N/1C.,10.  ,2*.001, 
A3*32,2E-0?/ 

PITA  H,H/g*a.,3*0./ 

EMI 
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SD^^OUTIHt  'OMT».Ot. 


•SU1»^II7:*IE  CONTJ»OL  '•.EMERfTES  THREE  TYPES  OF  COI^anOS  FOR 
•OEl.Tft  MO  RETA, 


crn'io‘i/ri«':5/T,n7,TP,OPFT 
rO<'1Ori/0O‘i’'’OL/Kn,BFTAC,OEI.TAC 
»FAL  Kl.KE.O.KA 

DATA  (Kl=  .:i3)  , (KSs.CT)  , (KJs.OC?) , (<*-=.  002)  , (Wls.l)  , <U2=.  2) 
TC=T*3T/2. 

IF<<O.EQ.1)10,20. 

13  nF!.TAC=<3*<’4*SIM(M2*TC) 

“‘^rAC*<l*TC 

PET'JRN 

20  TF(KO.'’0.2)  TO,  VO 
5 3 nE!.TACs<3 

'5ETAC=K1*TC*<2*SIM(W1*TC) 

PETURri 

VO  PETAC=K1*TC*K?*ST)4(W1»TC) 

Ot:LTAC=<3*<V»SIM{M2“TC) 

returm 

p'n 

SIHROUTINP  ny^AMIC 


•SUR=‘01)T:n£  OYNA^IC  calculates  the  values  of  OETAjOFLTAjO  (PITCH 
•RATE), alpha  (A‘ICL"  OF  ATTACK),  AND  L (LIFT)  5ASEO  ON  AN  EJLER 
•INTFP.P.A’’IO*J  RO'.ITIHE. 

• »»  ♦4*»*-»**  *4 

CO<*10N/TI^*c'’/T,OT,TF,OPCT 
COiHON/3YMA-»TC/3FTA,OrL‘fA  ,Q, ALPHA  ,L 

C01HON/OL  AH</CHA (3 , ?) , Gf M A ( 3, 3) ,5 AHF ( 3, 3 ) , SF ( 2, 1 ) ,GA3 (3, 3 ) , 

5LI«’T  (3,1)  ,njT(?,l)  ,0UTM(4,‘+)  ,0UTPU(7,1)  ,F0,  ACC(3,1)  ,S0UTEPF(!»,3) 
OITENSIOH  U(V) 

PEAL  L,LIFT 

U(l)=OErA 

U(?)=OELTA 

iJ(5)sO 

U(V)sALPHA 

r,Al<l,l)=l, 

GA5(2,2) =GAP(3, 3) =COS(U(l)) 

6A'){3,2)=SIM(U(1)) 

GA*5(2,3).  = -r,An(3,2) 

GA5(2,1)=GA0(1,2) =6A0(3,l)=GAn(i,3) =0. 

<=■♦ 

call  EULrNT(U,<,.01) 

OETAsU(l) 

0ELTA=U(2) 

0=1(3) 

AL’HA=U(4) 

PETu^i^N 

FNO 

SU’PO'.ITINE  NOMINAL 

•SUPPOUTI’JE  nominal  CALCULATES  THE  VALUES  OF  THE  MISSILE  POSITION 
♦AMO  VELICITY  Ifi  THE  A/C  FRAf‘F,?ASEO  CM  AM  EULFR  ROUTINE. 


CO'(MON/riMFR/T,Or,TF,?PP7 
CUMON/EOSILO.'I/PSI , TETA  ,PHI 
r.O  IMON/NO-IMAL/X,  Y,2,  VX.VY.VZ,  V 

COMMON/5LAM</CMA( 3,5) ,GTMA(3,3),GAMr(3,3),SF(3,l),GAP(3,3), 
ALT'^T(3,l)  ,0'JT(5,i)  ,nUTM(V,4),0UT?U(7,l),Fn,ACr(3,l)  ,S0UTEPS(4,3) 
PtIENSION  U(«.) 

U(1)«X 

M(2)«Y 

Il(3)a2 

M(*)«VX 
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if<T»*vy 
U(  l)avz 
<»» 

EULIMT(0,i<,.3i) 

Va'?0'>T  ('J('i)  ‘iJCt*)  ♦U(':)  •U(5)*U(6)*U  (6)  ) 

Xa-Ml) 

V»M2) 

7s’J(3) 

VXsU(4) 

VY='J(5) 

VYstJCS) 

Ck|-J 

S'nRouTiNP  '?p‘^o‘>.C" 

•SUT^nU'tNS  SP'^C'^CE’  CSL'^UHTE'  THE  SPECIFIC  FQPCES  MEASURED  THE 
•THPEC  ACCELESIOMct?^-?  on  the  *‘ISSILE. 


r.0<‘10M/TI>'E'?/T,nT,T=‘,GPPT 
r'i<H0N/EP5IL0‘l/PST,TETA  ,PHI 
rOiMON/OYMAiI~/r^r7A,TrLTA,a,AUPHA,L 
C0■^M0N/f{0^'I^JaL/X,  Y,?,  '/X,VY,'/Z,  V 

C01H0N/?UA.'</CHA(T,7)  ,GAVA(I,3)  jGAME  ( 3, 3 ) , ( 3, 1)  ,G»3(3,3), 

XLIPT(3,1)  ,OJT(^,l)  ,0'JTN<<*,h)  ,0UTP>U(7,1»  ,F0,ACC(3,1)  ,S0'JTrpS(4,3) 
OUENSION  GA  (3,  1)  ,GAF(3t3> 

“"AC  L.LIFT 

I.I=T  (3,1)=-L 

LT^T<l,l)=LTFr(2,l)=0. 

AaS'J'^T  (VX»VX  + '/Y*VY) 

V1  = VX*PSI'‘VY-TE‘^A*VZ 
y23-o5x*  vx  + VY*f>HI»\/Z 
'/TsTSTA*VX-PHI*  YY»-VZ 
GAHA (1,1)=V1/A 
GAHA(2,2)=GAMA(1,1) 

GAHA (t,2)=-V2/A 
GA1A(2,1)=-GA1A  (1,2) 

GAHA (3,3)=1. 

GHA(1,‘*)=GAMA{3,1)-GAHA  (2,3)=GAhA(3,2)sO. 

GAiE(l,l)=A/V 

GA1E(3,3)=GA*'-{1,1) 

«A(E(3,1) =73/7 
GAHE(1,3)=-GA.‘1E(3,1) 

GA-(E(2,2)=t. 

GAH=(i,2)  =-,AhE(  2,1)  =G AMT (2,3)  =GAHE(3,2)  = 0. 

CALC  '1ATH{GA«A,CAME,GA,3,3,3) 

CALL  MATH(GA,GAP,GAF,3,3,3) 

CALI.  HATM(GAF,LIpT,SF,3,3,1) 

PET'JRN 

ENO 

S’J3R0UT1'IE  HEAStRE 

•SUP^O'lTflE  MEASURE  CALCULATES  THE  liANGE,  PANGE  RATE, AZIMUTH, 

•ANT  ELP7ATICN  AS  HrA<;M?PC  ’Y  !»£  RAOAR  If:  THE  A/C. 


CniMOM/TIMe-P/T,  nr.TF.OPFT 
'•01MOM/MO‘'IN  AL/X,  Y,?,  7X,  VY,  VZ,  V 
CO  IMON/NOISYA  ?/P•l,PD^•,FSIPN,TETP^4,FlH,F^N,F3N 
ra(MOM/9LA*l</CMA(3,3)  ,G/HA(3,3)  ,GAHP  ( 3, 3 ) , SF  ( ’,  1)  ,GA3(3,3), 
tLtPT(3,l)  , OilTC',1)  ,0(JTf!(4,^)  , OUTRU  (7 , 1 ) ,FO  , ACC  ( 3,  1)  , SOUT  EPS  ( L , 3) 
CO(HOM/LOfrC/MOOEl 
LOGICAL  MOOEl 
M'l»  0 • 

RaSCRT (X*X»Y*YfZ*?) 

•n*  (x*vx*Y*yY4-»-*v') /R 

OGXR*Y/SOOT (X*X»Y*Y) 

TETAR*Z/R 
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iPC*iooti)  r,D  TO  10 

C1UL  NOI7F(^.N,0.,MM> 

10  O'JT  (l,l)sP»WN 

T^(IODCl)  '■•0  TO  20 
COL'.  MOI7P(pn  it  C.fWN) 

>3  our (2, l)=PO*WM 
IF("tOOtl)  r.O  ro  33 
CALL  NOI?*’{'’SIPU,3.,VIM) 
33  0!IT(3,1)=«=SI»+HU 
TPCIOOEl)  CO  TO  43 
call  MOITFC-FT^H,  3.  ,WN) 
•*0  O'JT  (4t  1)  =7^ra?>WN 
TF(MOOEl)  00  TO  50 
'“••LL  N0I2E(F1N,:.,WN) 

;0  0"T(5,1)  =5- (l,l)TWNr 
1^(10051)  r,n  TO  63 
CALL  N0rZE('=’?*4,  0.  ,WN) 
iP  0'|T(6,1)=SF(2,1)*WN 
IFdOOEl)  00  ’0  70 
call  NOIZE(F?‘J,0.,MN) 

'3  mjr  (7,1)=S'’{3,1)>WN 
P-TURN 

5'n^OUTIUE  F{ll,P) 


•SUPPO'ITIUE  F calculates  THE  CEPIVATIVES  heEOED  FOP  THE  EJ-EP 
♦INTEC"ATION  FOP  SU3P0UTIf!ES  DYNAMIC  NOUIMAL,  ANO  SENSTAT. 

C01'10*J/EPSrLnN/oSI,TETA,PHI 
CO-IMQN/OONTPOL/KD.nETACjCELTAC 
CO  <>10U/OY‘'AMIC/PETA  ,OELTA  ,Q, ALPHA, L 
COnON/NO'TNAL/X,'',  7,vy  ,VY,V7,V 
CO  |M0N/5ENST;T/S"PSr(3, 7)  ,SEPS'/(3,3) 
rO'1‘<ON/‘JOI':'/A'’/PN,Pnu,Ff  TPN,TETP.'J,F1M,F2N,F3U 
CO-fMON/INPOMAT/MCC,?)  , H (3 , 1)  , OH  (3 , 3)  , 0^  ( 3,  1) 
CO^HOM/OLAmk/CHAC  3,7)  , GtM  j (3 , 3 ) ,r.  AHf  ( 3, 3 ) , SF C3,  1 ) ,CA  ? { 7 , 3) 
ILT'^TCT,*)  ,0JT(7,1)  , OUT  M (4,4)  ,0UTPU<7,i)  , FO  , ACC  (3 ,1)  , SOUT  E® 
COHMOri/LOGIC  / 100E1 
OJHENSIOM  !J(33),P(36),0"TF(3,1) 

LOGICAL  MO^El 

PEAL  LAHOA,ML',L,HO,MA,Hn,LA,LO,LIFT 

OAJA (H0S-.462) , <MA  = -5.ai)  ,(M0=-72.C) , (LA=.37q) , (LO^.CoOO) , 
n(LAHOA=10.)  , (U'J=3  3,)  , (0=32.2) 

IP  (FO)  1C, 20, 30 

•SUOPOI'TTNE  P ^op  eu^pouttne  CYNAMIC 
10  P(l)  s-NU*  (Ud) -PETAC) 

P(2)  =-LAH0A*  ('J(  2)  -OELTAC) 

P(3)=HQ*U(7)  ♦ lA  •!)(*. )»MO‘^U  (2) 

P{4)sU(3)  -LA»!)(*.)  -L0*U{2) 

L=-'/*(P(4)-’J(’)  ) 

PPTUPU 

»SU3»0M*InE  F Ppp  SOIPOUTINE’ f OHINAL 
23  1P(MOOE1)GO  TO  25 
“(1)=U(4) 

P(?>=U(5) 

o(3>=U(o) 

CALL  HATH(CHA,SF,ACC,3,3,1) 
o(4)«ACC<l,l) 

P(T>»AC:(?,1) 

P(4)»ACC(3,1)»G 

“"ru9*i 

25  P(t)=U(4) 

P(?)alJ(5) 

o(3)»'J(i) 

0'irF(l,l)=0UT<5,l) 

0**TP(2,1)=PUT<6,1) 


wl  «* 


a 


OllfFIJ  ,l  ) =-J.I  ■ I ^ il) 

»*SLL  1ArM(CH4,0UTF,/»CCf  7i3,1) 
9(4)sac:(Ii1) 

P(S»»AC0(2,1) 

PC»)«AC:(?,l)fG 
i:  no  13  1=7,15 

3*;  rosTIN'JE 

P(l%)*-S‘^(2, 1) 

P(l7)sSP{3,l) 

»(19)»SP(1,1) 

»(?1)»-SP(1, 1) 

'»C13»=-SP(l,l) 

0(14)=S- (?,1) 
OC15)=«»(2<:)='’(22)=0. 

00  36  J=l,3 
00  36  1=1,^ 

P(11»I*1*J)=0M(I,  J> 

36  CQITINUE 

00  37  1=1,3 
O(33*I)»0-'(I,l) 

37  CONTINUE 
PETURH 
ENO 

SU090UTIME  S^nSOMT 


•5U090UTIME  SE'J^OUT  CALCULATFE  THE  OUTOUT  (P40AP.  HEASUREHENTS  ANO 
•SP'OT^TO  E09CE*:)  SENSITIVITIES  W.=,.T.  THE  MISALIGNMENT  ANGLES. 


C0AN0N/riHr3/T,0T,TP,0PET 
CONNOM/NO":NAL/7,V,7,'/X,Vy,VZ,  V 
common /SE'!STAT/S"3SP(3, 2)  ,SE''SV  (3,3) 

OOMMON/SENS  = OT/S9“°S  d,.’)  ,S90EP3(  1,3)  ,SoS9EPS  (1 , 3)  , STE9EPS(  1 , 3) 
C0<N0N/‘*LAN''/C'«A(3,3)  , Gf  m a (3, 7 ) ,G  AHE  { 3, ’)  , SE  ( 3, 1 ) ,GA3  (3 , 3)  , 
nLI^H3,l)  ,njT(7,l)  ,CUrN{U,4)  .OUT^UC?,!)  ,P0,ACC(3,l),S0UTEPS(t.,3> 
DIMENSION  PR{1,3) ,VV(i  ,3)  ,XY (1,3) ,XYZ (1 , 3) , TE^Pl ( 1, 3)  ,TEM02(l,3) 
P»0UT(1,1) 

P»(1,1)=X/P 

P?{l,2)»Y/9 

PP(1,3)=Z/P 

P‘;9*CX*VX*Y*VY*7‘V7)/(P*R) 

VRdjDsCVX/o-aV-^^P-d,!)  ) 

VPd,2)=(VY/^-oVO‘PP(i,2)  ) 

V9(l,3)=(V7/e-aV9-»Pnd,3)  ) 

CALL  MA:M(f9,SEPS'>,r9EPS,l,3,3> 

CALL  NATM(V9,SEOSP,TEmP1,1,3,3) 

CALL  MATM{9o,«;ppr,7,TE.MP2, 1,3,3) 

00  13  1=1,3 

SO.DEPS  (1,1)  =TEMP1  (1,1)  ♦TEMP2(1,I) 

10  CONTINUE 

XY(l,l)  = -y‘ Y/SO'SK  (X*X*V*Y)**3) 

XY(1,2)  = X*'X/S09T(  (X*X»Y*Y)»*3) 
xy(i,3)=o. 

CALL  MArM(XV,srPS'’,SPSREPS,l,3,3) 

XVT(l,l)=-X*^/?**3 

xr3(l,2) =-Y*7/9*=3 

XYT(1,3) = (X*X*Y*Y) /R**3 

CALL  MArf1(XYZ,3EPSP,STEPEPS,l,3,3) 

PETU9N 

END 

SUIROOTIN®'  NOrZE  ( 9»'SN0TS  , CUTmEAN  ,H)!) 

♦SUOOT'TINE  NOIZE  calculates  the  values  op  the  MEASUREMEUr  N3ISE 
•COMPONENTS  USING  A RANOOM  NUhpER  GENERATCR  MOOELLCO  AS  GAJSSIAN. 

COMMON/NOJSyAR/RN.RO.NiPf  JpNjTETiiN,PlH,F2N,F3M 


ILT^T  13,1)  ,0JT(7  ,1)  ,0'JTN(<.,u)  , OUT^U  <7 , 1)  , FO , ACC  ( 3, 1) , SOUT  EPS  ( «*,  3) 

c»  jssa 
m 10 

r,A  J“S=GAIJSS»P.A^iP  (OUP) 

13  COSTIrH'i 

r,A  ISS=r,A'.I^S-6.*0MTMEAN 

MMs3AIJS3“»HSNOIS 

PETUPtl 

FMl 

S'npoUTINE  INFO  MAT 


•SinPOUTISF  IMFO.'^AT  calculates  the  values  of  the  infopnatton 
••<ATi?rx  '.NO  GPAOIENT  '/ECTOP  IfCRENENTS. 


CO'<NON/TIMr?/T,')T,TF,OPPT 
COiNON/EPST=>UE/PSIT  ,TET«T  ,dhIT 

rONHON/SEMSRO'/SP^IPSd,?)  ,SPDSPS(  1,7)  ,SPSPEPS  (1 , 3)  , STEPEPSC 1 , 3) 
rn'1NON/INFOriAT/H(3,'»)  ,H(3,1),DM(3,3),0N(3,1) 
rONNON/3LA'I</CUa  (3,3)  ,G£MA(3,  3)  ,G  AHF  { 3, 3 ) , SF  ( 3 , 1)  ,GA3(3, 3), 
tLT-T(3,l)  ,n'JT(7  ,1)  ,OUTN(•♦,^)  ,0UTRU(7,1)  , FO  , ACC  (3 , 1)  , SOUTEPS  (4, 3) 
COIMON/LOGIC/MOOEl 

real  M 

LOGICAL  NOOEl 

nnEnsnM  S0UrPST(3,4)  ,TEHPi(3,4)  ,00UT(4,1) 

00  13  I=l»7 

S0  JTFr>S(l,I)=3PFPC  (1,1) 

S0JTF'»C(2,I)  =S'»nEPS<l,I) 

S0UTFos{3,I)=SO3RZPS(l,I) 

S0UT£PS(4,I) *ST 'PEPS (1,1) 

10  CONTINUE 
NO  20  1*1,4 
00  20  J=l,3 

SOUEPSK  J,I)  =SOUTFPS(I,J} 

20  CONTINUE 

CALL  H4TN(S0UFPST,0UTN,TENP1,3,4,4) 

CALL  NATKTEMP1,S0UTEPS,0h,3,4,3) 

00  30  1*1,4 

O0’IT(l,l)*0ltT^U(I,l)-0UT(I,l) 

30  CONTINUE 

CALL  MATMdENPl  ,00UT,0H,3,4,1) 

RETURN  , 

ENT 

S'llROUTINE  rULiNT  (U,<,0T) 

OTNENSION  U(3o),P(3f.) 

CALL  F(U,P) 

00  10  J*l,< 

»'(J)  aU(J)*P(J)*OT 
1C  CONTINUE 

return 

ENO 

S'HRO'Jtine  '«ath(a,p,c,ii,k,n) 

NINCrjsiON  A(N,K)  ,T('',N)  ,C  (N,N) 

no  10  J*1,.N 
00  13  1*1, N 
C(I*J)*0. 

00  10  L*!,^ 

10  C(ttJ)»3(I,J)*A(I,L)*R(L,J) 

return 

EMI 
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P’OGOAi  SI‘1iJL’<  INPUT,  OUTPUT=10023,TAPE2=103  20,  TAPE:5  = 10t)2B, 
^TAPElDsDUTPiJT) 

♦PROr.PA’1  SIMJ;.  IS  A ST*<'JLATIOr  0”  THE  TPATKINR  ANO  CONTROL  OF 
♦AM  ATP-TO-r,?0')‘^?  .-ISSTLE  'JSltG  MAXI'iUM  LKELIHOOD  ESTIHATIOU 
TUP  THPEE  AUGLE*?  PEPRESEt;’ ING  ITS  INITIAL  HIS  ALIGNHENT . 

rO'IMOH/ T I S'E-I /T  , OT , T P , OPT T ,U , « 


►OF 


COMMON/ EPSTP'.IE/ PST  T,Tfc'TiT,PHIT 
Cn-1MON/EPSn/PSTO,TFTAO,FHlO 
COMMON/ : ONTROL/ Fn, set  4 0, OFLT AC 
C31H0M/DYNAMrc/PETA,SEUTA,Q,ALPHA,L 
rOMMOH/NOHr‘l4L/X,Y  ,Z,VX,VY,  VZ,  V 
COMHO'i/9AOAP/P,PO 

COIMON/INITIAL/XO, YO,2C,VXO,VYO,Vto 
COMMON/SEMST4T/3=‘P3F{2,7)  ,S£PSV{3,3) 

COMMON/SENTROT/SPEPSd,?)  ,SPOEPS(  1,3)  ,SPSPEPS  < 1 , 3)  , STEREOSC 1 , 3) 
COMMON/SENSFP.S/SFIEPS  (1 ,3)  ,SF2EPS  (1 , 3 ) , SF3EPS  (1, 3)  , SFEPS  ( 3,  3) 
<,SPEP31(3,3)  , 1F0Y(3,3)  ,TEmo?(3,3) 

COMMON/'iOISl'/ =/=-►!,  RON,  FE I RN,TETP.N,  FIN,  F2N,F3N 
C0MM0N/IN''r'M4T/M(3,3)  ,M(3,1)  ,0M(3,3)  ,CH(3,1) 

C0MM0N/nLAN</CMA<3,3) , GftM A (3 , 3 ) , G AMF ( 3, 3 ) , SF (3, 1 ) ,G A3 ( 3 , 3) , 
\LT=T(3,1)  ,0'JT  (2,1)  ,CUTN(7  ,7 ) .OUTRU  (7 , 1)  ,F0  , ACC  (3, 1)  , tfl  , V2  ,V3 
?,SOOTE3S(7,3) 

C01MOM/LOGTC/MOOE2 
logical  M00E2 

DIMENSION  'l(Zo)  ,W<A?EA(ia),MI(3,3),FPS(3,l) , FIRST (3 , 1 ) , SFCONO ( 3 ,1> 
L,05(6),H0TS(  ,)  , Dv/M(7,1)  , OSF  ( 3 , 1 ) , HOTSF  ( 3 ) , TEHFl  (3,1),H3TYM{3) 
<,TYHE(5)  ,0FLT0!IT(t«,7)  ,)  OTOUT  ( 18,7 ) ,TRa(18)  ,0FSI<13)  ,')TETA(18)  , 
LOPHKl?)  ,SF1  ( i)  ,SF2  (6)  ,5F3(G)  ,XTT  (C)  , YTT(«=>)  ,ZTT(8), 

^VXTT(G) ,VYTT{ j) .VZTT (6 ) ,R TT (S ) ,RaTT (6 ) ,PSIP (3 ) , TET A? ( 3) , 

LPHIO(3)  ,00'IT( 7,1)  , HOT  (7)  , TAYLOR (7,1) 

REAL  L, LIFT, H, MI 


•INITIALIZATION  OF  THE  RANOOH  NU^ioFR  GENEF.ATOP  FOR  NOISE  GENERATION. 


P?INT(10,?8) 

CALL  P.ANSET(JJ) 
r)»RNTs3  . 

T*3  . 

MOOEZ*, FALSE. 
PRINT*, "♦••TRUTH 


♦INITIALIZATION 

•TRUE. 


MODEL  **•" 

OF  THF  MISALICNMENT  ANGLES  WITH  VALUES  ASSJMEO  TO  RE 


PST«PSIT 

TFTA»TETAT 

PHI*PHIT 

AOSI»ATrTAsAPHT! 
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OPPINr''tO»4  3-  THF  misalignmfmt  angles  transformation  matrix. 
1.  -»si  teta 

ONA*  BSl  1.  -PMI 

-teta  ohI  i. 


CNA (1,1) aCMA (2,2) =CMA (3,3)=1. 

GMA(2,1)sPSI 

'^■n(3,l)  s-TETA 

Cn(3,2)=PHI 

CMA (1,2) s-CMA (2,1) 

r n (1,3)  =-''MA  (3 ,1) 

C‘\(2,3) s-CMA(3,2) 


♦INTTTALTZATI3N  0'^  POST  T0>', 'yELOCI  TV  , ANO  S''ECrFIC  FOPCE. 

s'f(i,i)  = a. 

«?‘f(2,l)=0. 

s<='(3,i)sa. 

XsXO 

Y»ro 

7»ro 

VXaVXO 

VV»VYO 

V’*w?0 

V»SQRT(VX* YX^Vy*VY^V2*V7) 

•EVAL^IATION  3F  TME  YALN"  np  the  states  for  tme  truth  model  . 

20  CALL  MEASURE 

W®rT£(2) X,v,r,7X,  /Y,V2,SF  (1,1) ,SF(2,1>,SF(3,1) ,R,RO 
MRITE(3)<?,T, (OUT  (1,1)  ,1  = 1,7) 

CALL  CONTROL 

F3»-l. 

call  dynamic 
R'>»0. 

call  nominal 

CALL  S®FOP.CE 

•^F(A3S(r-0PRNT)  .LT,1,E-C6)G0  TO  ^0  . ' 

30  T«T*DT 

IF(T,LE.TF)r.O  TO  20 
GO  TO  50 

VO  PRINT  (10, 39)  X0,'>ETA,CELTA  ,C  , A LPHA  , L , X ,Y  , Z,  7 , YX,  VY  ,7?,T  , 9ETAC , 

AnELTAS,3='(l,  1)  , S-  (2,1)  ,5=-  (3,1)  ,OIJ  T(  1 , 1) , CUT  (2 , 1)  , OUT  (3 , 1 ) ,OUT  (4,1) 
A,A0C(1,1) ,ACG(2,1) ,ACC(-,1) 

PPINT(10,'9)T, (0"T(I,1) ,1=1,7) 
noR*IT»OPRNT  + nPRT 
GO  TO  30 
GO  R"  IINO  5 

PRINT*  , •••♦♦MODEL  ^•♦••* 

M03E2=.TRUE. 

«RINT*,^^MOOE2  = *^,MOOE2 

PSI»PSI3 

vptasTETAO 

PMT.ohio 

00  ICO  NN=1,3 

NaMN 

PEN I NO  2 

TaO  . 

OpRMT*3. 


•INI'IALITATTOM  of  the  MISALir.NNEHT  ANGLES  WITH  THE  ESTIMATED 
•nominal  values. 


PGraPst»Ar<:T/i  ono 


■’TTA*TsTA»AT-Ta/i30  0 
omt»PhT»APHI/10:1 
osTe(H)  = noc*:’‘;: 

■^-'rAocii  =io:r*T?’’’A 

OMtP(rj)  slJ 

r«A(l,l)=CIA  (’,2)sC»'A(3,3)  = 1, 

PV*(2,1)=PSI 

C <1  (3,1)  s-TPTA 

0*ni3,2)=P‘)I 

C*M  (1,2) s-CMA(2,l) 

CSl  (1,3)  a-C‘?A  (3 ,1) 

C'*l(2,3)  a-C  fJ(3,2) 


•IMTTTA'.rTATION  0-  "'O'^TTION , VfLCC  ITV  , SP  ^C^FIC  F^pCc,  AE^OTfSAilC 
•VAL'Jc’?.’:r|e-0?.-«.'VTTON  AMT  OISf-tfSIOM  MATi^IX  EUEMEflTS  ANO  TP.ACE, 

♦AMO  ‘T-M^ITIVITIcS. 

Xa<0 

Y=YO 

?s?0 

VXaVXO 

VYa«/YO 

V-aVZO 

S='(t,l)»0. 

’;f(2,i)=o. 

*;=-(3,l)a0. 

HETAsO. 

n"LTA«0. 

0*  J . 

A(,=»HA»3. 

L«3. 

no  55  1*7, 3fi 
l)(I)»0. 

55  COMTIM'JE 
00  52  1*1,3 
00  52  J»l,3 
S-»S®(I, J)=3. 

•:”5V(I,  J)=0. 

Se-IPSd,  J)  = 0 . 

•*(r,j)s5. 

••I(1,J)*0. 

52  CONTINUE 

0t)TN(l,l)=l./(OM*9M) 

0'rTN(2,2)  =1  ./(^CM’filON) 

0'»TN(3,3)=l./('’':i9N*BSIPN) 

0‘ITM(**,!*)al./<TET'’N*TET‘^N) 

0UTN(r.,5)=l./('^lM-‘FlM) 

OMTN (5,5) =!./(- 2M*F2N) 

0')TN(7,7)al./<F3N-F3N) 

O')TN(l,2)=0!ITf|(l,  3)=3UTK'(l,i*)=OUTN(l,5)=fiMTM(l,6)=OUTN(l,7)=0. 
0')T‘M2»1)  =OUT:|  ( 3,1)  =OUT»  (‘*,  1)  =OlJTfl  (?• , 1)  =CiJTH(f  , 1)  =OUTN  (7 , 1)  = 0 . 
0'»?N(2,3)=0’JT-|(?,-)  aCUTf  (2,5)=OUTr;f?,6)=CUTM(?,7)=3. 
n;)r‘|{3,2)  *OUT  J(-,3)  =CUTf  «5,2)=0UT;|(*'  ,2)=CirrM(?,2)=0. 
OMTr)(3,U)=OJT'l(7,5)  =OUT?.  (3,5)  =0'J’’tH3,7)  =C. 

0'*TN(4,3)  =31'T‘|(  P,  3)  =0'JTt  (S,3)  =OUTN  ( 7 , 3)  = 0. 

0MrN(4,5)  =0'JTM(-,  6)=CUTr  {•»,7)  =0. 
OUT:)(5,:»)=OI)TN(c,-.)=OUTK'(7,4)=0. 

■0tiTN(5,5)=OUT-|('5,7)=0. 

0'ir*((6,5)=OUTN(7,5)so. 

0’)rN(&, 7)  =01IT"U  7, c-)=0. 
no  50  «sl,iuci 
9£A0(5)<0,’’,  (OUT^'Jd)  ,1  = 1,7) 

0"^(1,1)  =GII-3')(5)  -5F(l,i) 
n9F(2,l)=0';re-H6)  -SF(2,1> 

O*;- (3,1)  aOUTO’KT)  -sr(3,l) 

CAUL  '•EASU9E 
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CatL 

TP(  («-l)  -13  0 0*  ( (KK-l)  / lOOO)  .?0.0)PPIHT  (1C  ,36)  ( (SC.lTc  PS  ( I , J)  , J = 1 , 3 

Cft'.L  IV^OMAT 
’’O  SI  1 = 1,7 

■)0)T(I,l)=OIJTP'l(I,i)-OUT  (1,1) 

SI  S^'dlMtlE 

F"3<t,l) =PSIT-oSI 
PP»(2, 1) =TETa“-T“TA 
=PS(7,1)=PM:t-PMI 

CALL  ‘•aTKSODTPos, EPS, TAYLOR, 7, 3,1) 

00  32  1=1,^ 

MO'd)  s30'JT(T,1)-TAYLCR(I,1) 

32  CONTINUE 

call  CONTPOL 
prja-l. 

CALL  OYMANIC 
POsl, 

Ps36 

call  EU';.IMT(U,<,  .01) 

00  56  1=1,3 
00  53  J=l,3 
PCPSPd,  J)=U(3*I+ Jf3) 

S-asVtr, J)=U(7*I*J*12) 

'•(I,  J)='J(:»3*J*2i) 

53  CONTINUE 
PO*0. 

CALL  NOMINAL 

PEA0(2)XT,YT  ,-^1  ,V/T,VYT,VTT,SF1T,SF2T,SF7T,pT,R0T 
IPC (KK-1) -1QC3* ( (<<-l) /1C30) .N£.0)GO  TO  51 
Y'T((i<<-1)/10DO*1)=XT 
YT’-{  («-i)/lC  )0*1)  =YT 
TTr((<K-i)/ic:a«-i)=ZT 
VYTTC  («-l) /I  JOO*!)  =VXT 
VYTT ( (KX-l) /1330+l)=yYT 
VTTT ((X<-1) /I iOO+l) =VZT 
( (KK-l) /ICOO  «•!)  =SF1T 
F'’2(  («-l)  / I 00  3 +1)  =S'^2T 
SPX(  (<<-!)/ 10)0  <-l)=SF3T 
*TT(  («-l)/1030  *1)  =‘>T 
POTT  ((’<<-1)/ 130  0 + 1 ) =PDT 
51  CALL  S?=‘0PCE 

IPCCKS-D-IOOO*  ( (<K-1)/1CS0)  . EO.Q)  PPINT  (10 , 37)  ( (SEOJ?  ( t , J)  , J = 1 , 3)  , 
»r»l,3)  , ( (SEPSVd,  J)  , J=l,3)  ,1=1,^)  , ( (SF£P5(I , J)  , J=l,7)  ,T=1,3) 

V1T  = VXT+PSIT*-VYT-TETAT*VZT 

V2T*-PSIT*7XT*VY*+OMrT*VZT 

V3T=TETAT*VXT-PMI7*VYT*VZT 

C71(l,l)=yiT-Vl 

OV-KZ,  1)  =V2T-'/2 

0'/M3,l)  =V3’‘-V3 

CALL  “AT‘1(OPn7,oyM,TEMPl,  3,3, 1) 

'’O  53  1=1,3  , 

“0’’SF(I)=C'Sr(  1,1) -TEMPI  (1,1) 

53  CONTINUE 
0S(1)=XT-X 
0S<2)»YT-Y 
ns(3)=ZT-Z 
'’5(4)»VXT-7X 
0~(5)=7YT-VY 
'aS(5)=V?T-V» 

CALL  MATM(SEP3P  ,E?S,PIF«T,3,3, 1) 

CALL  MAT-'(SEPSY  ,EPS  , SECCNO  , 3 , 3 ,1 ) 

CALL  MATM(T‘^Ma5,EPS,T£)"-l,3,3,l) 
no  54  1=1,3 

HnTS(I)=OS(I)-riPST(I,l) 

MflTVMd)  anVMd.D-Tf^PKI,!) 
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3-  CTITIM'JE 
no  33  I=t»»o 

HOT3<I)  = DS(T)  -seOi1MD(  (I-3),l) 
oa  CT4TIIIUE 

I- ( <«-:) -1C <3  :*  ( (>'<-1) /looc)  .NE.a)r.o  to  75 

P"TNT(  10 ,7^)  n~,  MO Tf> 
o=:‘lT(lC,73)nvt,MOTVM 
10 , 71*)  00='  fMOT^F 
B^INTdO.SD'^OUT.MO-' 

P'*T‘4T(l  j f 70)  T,  {'’i)T?i((I1.I=1»7) 

e?lNT  ( i:  ,0'^)  "*^76  jOELf  A ,0,ALPMA,L  ,X  ,V,7,  V,  VX,  VY.VZ.T.aETAC, 

<n'-'.TaO,3F<l,  1)  , (Z,l)  »‘’F  (3 ,1)  lOUK  l,l>  ,0'JT  (?,1)  ,007(3,  l ) ,0JT  (4,1 

».  ,A:C(1  ,1  ) ,AOC  (’  .1)  , ACC  (3, 1) 

TVv)C((i«_i)/i.;0.;,tl)  SCXI'-D/IOO. 

00  57  1=1,7 

"-LTO'JK  (6*  (M-l)  + (K'<'-i)/ia00Tl)  ,I)=POUr  (1,1) 

MOTOUT<(5* (N-1) ♦{<K-l)/:OOJ+l),I)=HOT<I) 

5T  COMTISUE 

IPfKK.EO.Dr.O  ■'0  59 

call  LIM\/2P(>!,T  ,t,mI,1C  ,MVAri'EA,IEP) 

TP0(5*  (N-1)  ♦(<'<-13  /100  0+1)=MI  (l,l)*MI  (?,  2)  ♦01(3,3) 
po  CONTIOUE 

PPINT(10,78) too(C^{m_i) ♦(<x-l) /lOOO^l) 

A«3I=(MI  (1, 1)  ^'.1  (3-)  ♦ n (1 , 2)*0(35)  ♦MI  (1,  3)*0  ( 36)  )*1J50 
ATETA=(0I(2,  1)  *0(34)  ♦mt  (2  ,2)*ij(35)+mi  {2,3)»U{36)  )»1C30 
APOI=(MI  (7,1)‘‘IJ(3-*)  ♦MI  (?,2)*U(35)^MI(3,3)»0(36))*1300 
0^31  (&*(0-l)  ♦(•<<-!)  /IC  C (♦!)  = ( PSIT-PSI)  ♦IOC  O-AFSI 


'’■'ETA(6*  (0-1)  ♦(  «-l)  /1G:C+1)  = (TETAT-TlTA)‘ID0C-ATETA 
03MI  (6*  (N-1)  ♦('<<-l)/lCCC41)  = (PHIT-POI)»1COC-APHI 
P?rNT(10,9?)  KO,M,OPSI  (6*  (M-1)  ♦(«-!)  / IOC  0 + 1)  ,PTETA(3* 
< (O-l)  ♦ (<<<-1)  / I 3 00+1)  ,OPMI  (6+ (N-1)  ♦(KK-1)  /10  00  41) 

73  CONTINUE 
60  CONTINUE 
P'=--»INO  5 
130  CONTINUE 

BCITP=1000*PSIT 

TETATPslOCC’TETAT 

PHITPslOOC’PHIT 

point (10 .14)  PCtTP.TETATF.PHITP 


TErATP=133C*TETAT 

PHITPslOOC’PHIT 

P9TNT(10,14) PCtTP,TETATF,PHITP 

14  FOEMAT(”i  T.P.UTH  MODEL”,  5X  , ••EPSITPUE=” , 2 ( E9. 2 , ", “)  , E9 . 2 , /I X , 
<0  = 3",///) 

P'>INT(tJ,l6) 

13  pO^MAT(2X,”TINE",')X,“X",13X,"Y”,13X  ,"Z”,13X  ,"P",/) 

00  17  1=1,3 

POIMT(10,15)TYNE(T) , XTT  ( I ) , YTT ( I ) ,7TT(I) ,RTT(I) 

17  CONTINUE 

ta  PO9‘iAT(2X,P4.0, 3X,4(E12.5,2X)/) 

B?I'IT(1G,19) 

19  '■n?-iAT(?X,"TINE”,3X,"VX-,  12X,”VY"  ,12X  ,”V7”,  12X  , "RO”,  7) 

00  21  1=1,6 

PPtNT(10,ia) TVME(t) ,VXTT(T) ,VYTT(I) , V 2TT (I ) ,ROTT (I) 

21  CONTINUE 
PRTNTdO  ,22) 

22  FO->NAT  (2X."TIM‘:",6X."SP.Ft?C.  (1)  ”.5X,”S?.FtC.  ( 2 ) ”,  5X , "SP  . FO.C  . ( 


PRTNTdO  ,22) 

22  format  (2X,"TIM-;**,6X,"SP.Fr?C.  (1)”,5X, 

00  23  1=1,6 

PPINTd3,2-,)TYNE(T)  ,SF1  (I ) ,SF2  ( I)  ,SF 
PY  CONTINUE 
24  p3?NAT(2X,F4.0,5X,3(E12.5,3X)/) 

00  15  N=l,3 

POINT (10  ,1)  P«;tiP,TETATP,0MITP,P5IP(M)  ,TrTAo  (N)  ,phio(N)  ,N 

1 P02NA7(”1  MOT  = L 2”,fX,”E°SITf(UE  = ”,2(Ei2.5,”,“)  ,E12.5,/3X,. 

fviITU  N3ISr”,3X,”‘P?I0=  " , 2 ( E12 . 5 , ” ,")  , E 1 2 . 5 , /3X , "KO  = 3”, 

<5X,"ITF2ATT0M  » ",Il,///) 

ORINTdO  ,2) 

2 FORMAT  («.x,”TI-lF",5X,”0ELTA(R)”,7X,“H0T(P)”,0X,"OELTA  (RO)  ”, 
1*iX,”M0T(R'')”/) 


:X,”S?.FtC. (2)", 
SF3(I) 


5X,"SP.FOX.  (3)*V) 


- iH'Pi 


1 1 


'I 


''o  u 

'‘’TMKIO  .■'JTvmx  (!)  jPELTfUK  (6*  (N-1)  ♦!  ) ,1 ) , HOTniT  ( (6*  (M-l ) ♦!)  ,1)  i 
(C*  (M-t ) ♦!)  ,2)  .HOTO'JT  ((6*  (fl-1)  »I),2) 

i*  ro  jTINUr 

. 3 ci>'UT  (!»x,r<».,)  , (*X,2(?.12.5  ,2X)  , 2 ( 2X  i ri2.'’0 /) 

5 'n^.HAT  ("Q'SSX,"!!  •tE",cx,”CtLTA(A7  .)  ",5X,"H0T(fi2,)",rx, 

X”'i-LTA(EL.)  ••,^;x,"HOT(EL.)  ",/) 
no  6 1=1, f. 

“oiNTt  13,3)  TYME  (I)  , OELTCUT  { (6*  ( N-1 ) ♦!  ) ,3  ) , HOTCUT  ( (6»  (*(-1 ) «•!)  ,3)  , 

» 0-LT0lJT(  (6*  (N-1 ) +1)  ,'»)  ,)  OTOUT  ( (6*  (H-l)  »I)  ,4) 

A ro  iTIMUE 

»’r‘JT(13  ,1)  ?STr  = ,TtTATP,PHIT‘>,P3I°(M)  ,TETAB(N)  ,0HI3{X)  ,N 
cprjTda,?) 

7 e-mAr  (ix,”ri't- ",  ‘PELTAC??!)",  IX  , "HO  T t $=■  1)  ",  2X  ,”DEL  T A (<?F2)", 

1!X,"H0T(SF2) ",2X,  .TA (£ F3 ) ",  IX, "HOT (SF3)"/) 

00  3 1=1,5 

'»PINTtlO,9)TY.>tE  II)  ,PELTrilT(  (b*  (N-1)  + I ) ,0  ) , HOTODT  ( (5*  (N-1 ) ♦!)  ,5)  , 
1.0ELTC’JT(  (£>•  (N-1)  ♦!)  ,5)  ,H0T0'JT(  (6*  ( tl-1 ) +1 ) , 6 ) ,DELT0!JT  ( (5*  (N-1) 
l+I)  ,7)  ,MOT01JT  ( (5^  (M-1)  41)  ,7) 

8 FONTINUE 

q P09-1AT  (1X,F4.C  , 1X,2  (E9.2,1X)  ,1X,2  (E9.2,1X)  , IX  , 2 (E9. 2, 2X)  /) 
ePINTdO,!!) 

11  FO^NAT  (5X,"TI-IE",';x,"T9fCE  0F"5X,  3(  SHFETI‘'ATE,4X)  /I'iX, 

l"OISP'!’9.SION",6X  ,3  (oHE^ROP  IN, -X ) / l7X  , "NAT^I X"  , ICX  ,"=31"  , 
tqx,"TETA",3X,"=HI"//) 

"0  12  1=1,5 

“PINT  (10, 13)  TYv)  Ed)  ,T90(E*(N-1)4I),0PSI(6*(N-1)4I),3TETA 
1 (54 (N-1) 4l) ,0FMI(54 (N-l) 4l) 

12  CONTINUE 

13  FOPNAT  (3X,'^4.0,5X,cl2.5 ,3  (3X,E9.2)/) 

^3  '^■)PNAT(1X,"0V  1=  ",3(E12.S,2X)/1X,"H0TV1=",3(E12.5,2X)/) 

15  COJTIN'JE 

36  FOTNAT (liy,3{E0.2,2Y)/liy  ,3(E3.2,2X)/11X,3(E9.2,2X)/1X,"E0UTEPS= 
l",3{E9.2,2y)/llX,  1(E9.2,2X)/11X,3(E9.2,2X)/HX,3(E0.2,2X)//) 

73  FOPNA’ (1X,"T9)=",E12.5/) 

7U  FO^.-IAT  (1X,"0S'^=  ",3{E12.5,2X)/iy,"linTSF=",3(E12.5,2X)/) 

77  cqPNAT  (l'<,"ns=  ",3(E10.3,2X)/16X,3(E13.3,2X)  71X,"H:Tq  = ", 

X‘»(E10.3,2X)/15X,3  t£13.3,2y)  /) 

31  FOdAT(lX,"noi)T  = ",i.  (ElO  ,2X)/1CX  ,3(E1’J.3,2X)/1X,"H3T  =", 
X4(E13.3,2X)  /ir.X  ,7(Fia.  3,2X)  /) 

7<?  F09NAT  (1X,5H0"’-'-'I=,C6.  (?X,  E9.2>  /13X,3(2X,E9.2)//) 

37  format  (11X,3  ((;n.7,2X)/3y,"SE3SP=  ",3  (£9.2,2X)/11X,3(F9.2,2<)  // 

dlX,3(E9.2,  2X)  /3X,"EEPEV=  ",  3 ( E9 . 2 , 2X)  / IIX , 3 ( £9. 2 ,20  // 
X11X,3(E9.2,2X) /3X,"EFEF?=  ",  3 (E9 . 2 , 2 X) / IIX , 3 ( EO.2, 2X)  // ) 

92  FOPNAT (1X,7H0-LFPS t ,11  ,?X,I1, 3E13.5/) 

Oa  FOPMAT  (3X,"K0”,  SX  , "'’ETA",  ftX,  "OELTA"  , ax,"0"  , 8X  , "ALFHA"  , 9X  , "L" , // ,5X 
1,"X",1CX,"Y",1  JX,"Z",1CX,  "7",lCX,"Vy",qX,"VY",  9X,"Vl",//,=:x,"T",3X 
I ,"3ETA3",6X,"0£LTAC“,17V  , "SFl" , 5X , "£F2", ?X, "9^3",//,  5X"P",9X,"ROOT 
1",4X,"P5I''",7X,  "T£TR",7>  , "A0C1",7X,"A  :r:2",7X,"ACC3",//) 

90  F3'>NA’'(5y,Il,  >X,0  (E10.3,1X)  /1X,?(E1C.3,1X)  /1X,F6.3,;X, 
l2(E10.3,lX),llX,3(£ia.3,lX)/iy,7(£lG.3,lX)//) 
q-OP 
EN9 


OLDOK  OATA 
°EAL  L,N 

CHNON/TIH"R/T,^T,TF,OPf^T,N,'<X 
r.O  r-»0N/E=9T3l,JE/^<:TT,  TETTT  ,PHIT 
CO  1NON/EPS:0/^3ro,  TETAO,P‘*IO 
CO'‘'‘O.N/CON’’?,OL/V'0,OETAC,''tLTAC 
rn  MOV/OYMA>1IC'/7:"A,OEL1  a ,0,ALPHA  ,L 
ro  mcN/INITI  AL/VO,  YO,2C,V''0,VY0,V7O 
C01'*ON/3EN?T4T/ ;=^PSP(3,d  ,SE»3V(3,3) 

CT1  10N/*'OIFV''.5/'?N,?''N,Fci  jfl.TETPN  ,FlfJ,F?H,F3N 
rO 1NON/INFOMAT/N(3,3) ,H(3,1) , ON (3 , 3 > , OH ( 3. 1 ) 
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nan  TT,Tr,oc'’»T/.:i,5t  ,,10./ 

-liTA  ,n-iiT/i  ,e-:3,2 

"ITA  P‘^TO,T'iTAO,=niO/i*C./ 
nara  ><')/3> 

para  3iT-i,'»"Lr4 ,p,ai. 3u/i,t./i*a./ 

nara  xo, ''0,70,7/'), wo, v70/2*iooc.,i:g.,20JO.,15CO., to./ 
oara  3-®SP,3'!:ao7/j.a*o./ 

OarA’  P'i,’n-l,P5T(^'4,  TtT=N,FlN,F2M,F3r4/2*lO.,2*.C01»3‘‘32.2E-a3/ 
nara  m,h/9*o.,3*o./ 

c*«o 

S'n^OyTIME  OONTPOL 

.<-i(.)9'’IITTME  CO'ITPOL  G£M£RaTES  T'^PEE  TYOES  OF  CCMMANOS  FOR 

• r~\_Tt^  aiO  9ETa. 

, ,^^.^»^.»*^9■*^.*■*l^*****•■*•**^,>^**•m 

ro^MO^I/TIM■P/T,OT,TF,OFFT,N,« 

Cn'*'«0M/:0*iTR0L/<O,  9ETAC,0EL74C 
*»EiL  Kl,i<2,<3,'<t‘ 

OATArKls.OO?)  , (K2=.03)  , (X3=.307) , (KA  = .30  2)  , <m  = .l) , (<<23.  Z) 
-03T»0T/2 
T'rKn.El.l) 1C, 20 
t:  n3l.TAC=<3+K!,*StM(W2*TC) 

«'^TAC=''l*TC 

“-•URfI 

2a  T-(<O.E0.2)30,40 
70  0EUTAC3'<3 

P-TACsKl^TO^-KZ^SI'l  (Wt*TC) 

RETURN 

•.C  PirACsKl^rC^-KZ^EINrWl^TC) 

OEUTAC=<3*'<i,*SIN(H2*TC) 

R-T'JRM 

ENT 

SUBROUTINE  OYNANTC 

•SU’POUTIME  OVNA'^IC  CALOULATEE  THE  VALUES  OF  “ETA,0ELTa,0  (PITCH 
♦FAT'^)  ,\L=MA(aN3LE  OF  ATTACX)  ,AN0  L (LIFT)  4»ASEiJ  ON  AN  EUL-R 
•INTF5R4TI0N  ROUTINE. 

• ♦*•**»«*♦•*• *4 ♦ **44 4 *4**»»44** 

COH'«OM/TI‘'ER/r,OT,TF,CPFT,N,!« 

COHHON/C>YMAMIC/BE*a,OELTA  ,0,aL?HA,L 

CO  ('‘ON/OLAMY/CHA  (7,7)  ,G;mA(3,.7)  ,GAHE  {3,‘»)  ,SF(3,1)  , GAP  (3, 3), 
K1.7-T  (3,l),OUT(?,l)  ,0UTN(7,7)  ,0UTRU(7,1)  ,F0,ACC{3,1)  ,V1,V2,V3 
oti-NSraN  U(4) 
real  L,L7FT 
Ufl)=3ETA 
U{2)=OELTA 
U(3)=0 

U(4)3ALPHA 
GAM  1,1)  =1, 

r,AB(2,2)  =GAn(7,  3)  =COS(U(l)) 

GABO, 2)  =SI'I  (U(  1)  ) 

Gaa(2,7)=-Ga9(7,2) 

017(2,1) =347(1,2) =GaP( 3,1) =GAO( 1,3) =C. 

K»* 

CALL  EI)LIMT(U,<,.01) 

PETAsUd) 

0“LTA='J(2) 

0=J(3) 

ALPHA=li(4) 

RETURN 

*■‘•1 

SUBROUTINE  UO'*INAL 

• •44«4«,a*.|.,«4,««4  44«4«4«4a*»»4 

•SUIROUTIHE  NOMINAL  CALCUtATES  THE  VALUES  OF  THE  MISSILE  POSITION 
•ANO  VELOCITY  IM  THE  A/G  FRAMFjRASE!'  ON  AN  EULFR  ROUTINE. 


il 

I 

i 

.1 
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:i7,T=’,0'f  T ,N,<K 
ro-*>ioM/t‘»r.rLO‘i/  "ST  ,T£Ta,PHi 
r''iiO‘j/*i3‘*T«jaL/y,Y,?,  vy,  v''»vz,  V 

( 7, 7)  tG/^*A (3, 1)  ,r.AMr ( 3,?)  ,5F (3,1)  ,';an(3,3) t 
tf-r  (3,1)  ,0  J’’(T  ,1)  ,CUTM(7  ,7)  ,001^0(7, 1)  ,n,ACr(3,l)  ,(/l,  V2,V3 
'JHE.'ISION  lj((>) 
l)(l)sx 
*J(2)^Y 
U(3)aZ 
U(*)aYX 
IJ(^)*VV 
"(o)=VZ 

fi«l.L  EULIN'T(U,'<  , .:i) 

V* >0*37(0 (4)  *IJ(4)+')(‘=)*U(5)+U((i)*U(6) ) 

X=')(l) 

Ya'»(2) 

7='J  (3) 

VXsU(4) 

VY=U(5) 

V»sU(5) 

“ETURN 

p»n 

S'J'»RO'JTINE  SPPORCE 

♦SUOROUriNS  SOPO’CE  CALCULATE'  Th£  SPECIFIC  FORCES  MEASURED  BY  THE 
♦THR-E  ACCEL ERO^fFTE'’.S  ON  TmE  I'IFSILE. 

C01HON/TIMrR/T,OT,TF,OP'T,N,<K 
CD  )MOM/£PSILO;i/  PSI , TET  A .PHI 
■ CDlHON/DYNC'HC/'jC'AtOEL'A.Q, ALPHA, L 
CD'IHON/NOmt'IAL'X,  Y,?,  VX,'/Y,7‘',  Y 
C3-*‘10N/3EMSTAT/SE'>S^(3,3)  ,SEPSV(3 ,3) 

CO(MOM/SEHS'PC/SriEFS(l,3)  ,S'2EPS  (1 , 3 ) ,SF3EOS (1 , 3)  ,SFEPS  (3,3) 
A,S=’E'‘3A(3,7)  ,0F0V(3,3)  ,''FMOE(3,3) 

CO  1M0M/BL  AMR/CM  fl  (3,7)  , G AM  A ( 3,  3 ) ,0  AME  ( 3, 3 ) , SF  ( 7 , 1 ) ,GA3(3, 3), 
^LtPT(3,l)  ,OJTC'  ,1)  ,0UTN(7,7)  ,0UTRU(7,1)  ,Fn,  ACr(3,l)  ,V1,  V2,V3 
CDHMON /LOGIC/ -lODEZ 

DIIEMSION  GA(3, 1)  ,G  AF  ( 3 , 1 ) ,TE‘1P1  ( 3 , 1)  ,TEMP2(3,1)  ,TEiP3(3,l)  , 
tTE')P4(3,3)  ,0GA71(7,3)  ,r'^AV2(7, 3)  , 0GEV1(3,3)  , 
nOGEV2(3,3)  ,0GEV3(3,3)  ,CA!i  (3,3)  ,OVEPS  (3,3) 

»EAU  U,LIFT 
LD'ICAL  MOOEZ 
LTPT(3,1)=-L 
LI^T(l,l)aLI'T(2,l)=0. 

VlaVX*oSI»VY-TETA ‘V7 
V2s.dct»\/x*’VY«’OHI*V7 
V33TETA* VX-OHI* VY*VZ 
Assort (vi*vi*72*v2) 

r.AMA  (1  ,1)  sVi/A 
GAHA(’,2)sCAMA(1,1) 

GA'IA  (1,2)=-V2/A 
GAHA (2,l)s-GAMA  (1,2) 

F-A<A(3,3)=1. 

GA'iA(1,3)=GAMA(  ^,1)sGA)‘T  (2,3) -GAMA  (3,2)  »0. 

GAME(l,l)sa/V 

RA*tE(3,3)=r.AM£(l,l) 

r,a-iE(3,i)  SV3/Y 
':A'lE(l,3)s-r,a‘<E  (3,1) 

GAMP (2, 2) St. 

GA'JEd  ,2)=CAM£(2, 1)  sGAHF(2,3)=GAHE(3,2)sO. 

CALL  '1AT*1(3AB,LIP7,GA,3,3,1) 
call  maTH(GAH--:,GA, GAP, 3,3,1) 

CALL  HAT'1(GAHA,GAF,SF,3,3,1) 

IP(M0DE2)G0  TO  13 

R'TUP.N  
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13  CTJTIMUS 

/'=';r)stT  /’*\/2) 

no  20  j=i,^ 
no  20 

''■;wl(I,J)=nG4'/2<I,J)  = 0CEVl(I,J)  = 0GCV2(I»J)  =0CP\/3(I,J)  =0. 

?3  CO'ITIMUE 

n-.l'/.Klt  DsnOAVl  (2,?)^V?*V2/A**3 

nnivKl,?)  =’/!♦  /?/A**3 

n“AVl(2,l)=-'?'',A7l(lt2) 

n';AV2(l,  l)=OGA  /?(?,?)  =-Vl*72/«**3 

CI';A72{1,2)=-V!.'>71/A**3 

'''.A;2(2,1)  1,2) 

■"‘.-VUl,  1)=3C:'/1(  3, 3)=71*V3*V3/(A*V*3) 

''“.iiVK  1,  3)  = Vl*y3/V**3. 

nn^'/i  ( 3, 1 ) = -nn- VI  ( 1 , 3 ) 

nG-'/aClt  l)=nc.-/ 2 < ■',?)=  V2*73*VJ/(A*7**3) 

nG“V2(l,3)=72»73/V**? 

n‘!iV2(3,  l)=-nG"72(l,3) 

n'',?V3(l,l)=TGiy’(3,2)=-r»V3/V*»3 

nr;"v3(3,  i)  = 4‘^;/7*“? 

no- 73(1, 3) =-00273 (3,1) 

('ALL  •lAT'1(0GA71,GAF,TEMri,3,3,l) 

CALL  •1ATK''GE71,r,A,-2^:F2, 3,3,1) 

CALL  ‘'Ar‘1(r,AMj,TE''P2,TE»  P3,3,3,l) 

CO  30  1=1,7 

n-nv(i,i)aTEMoi  (1,1)  ♦Te)'P3(I,l) 

33  CO*fTIMUE 

call  HAT‘((05A72,GAF,TE)'ri  ,3,3,1) 
till  mATH(0<*,E72,5A,T£mCC,3,3,1) 

. CALL  MATM(GAMA,TEM°2,T£f'P3,3,3,l) 
on  40  1=1,3 

n'^lV(I,2)  =T- *131  (1,1)  ♦TE''P3(:,1) 

•*0  COmTINUE 

CALL  MAT‘1(n3E/3,GA,TE^'Pl,3,3,l) 

CALL  *1ATM(GAMA,TEMF1,TENP2,3,3,1) 
m 50  1=1,3 
0Fnv(l,3)  ='^£M02  (1,1) 

30  COITIHUE 
on  60  1=1,3 
no  80  J=l,3 
rAK  J,I)=CHA(I,  J) 

60  Cn'lTIMME 

n7EPS(3,2)=7X 

nV2PS(2, 1)=-VX 

nVEPS(l,l)=VY 

nvEPS(3,3)=-VY 

C7EPS(2,3)=V7 

''Vr'>S(1.2)=-7-» 

OYEO^d,!)  =nv-=S(2,?)=CVEoS(3,l)=0. 

CALL  nAT'1{r.l'1,SE05;V,TEHF4,3,3,3) 
on  70  1=1,3 
on  70  J=l,3 

•^£'<“5(1,  J)=TE*-P4(I,  J)*PVEBS(I,  J) 

70  covTI‘)UE 

CALL  MATM(ner)7,TEHFE,SFE°S,3,3,3) 

Ip(  («-l) -1C00-*  ( (<K-1) /lOOC)  .ME.O)GO  TO  80 
P^INTdO,?!)  ( OVEOSd,  J)  ,J=1,3),I  = 1,3) 

P’tNT (10,72)  ( (TFn=<.  (1,  J)  , J=l,3)  ,1  = 1,3) 

S'»INT(i:,7  3)  ( (TE  1P5  (I,  J)  , J=l,3)  ,1=1,3) 

PPINK  10,74)  ((n'^nV(I,J)  ,J  = 1,3)  ,1=1,7) 

71  FORMAT (11X,3("12.5,2X) /7X,”OV£PS=  ", 3(E12 .5 , 2X) 7, IIX , 3 ( E12. 5, 2X)  / 

%/) 

72  Fn^1Ar(llX,3(El.?.‘',2X)/7X,”TEMP<,=  ",  3(C12. 5, 2X)  / , IIX , X ( cjg.  5,  gX)  / 

</)  * 

73  FO(MAT(liy,3(£12.n,2X)/3X,"TEMP5=  " , 3 ( E12. 5 , TX) /, IIX,  3 ( F12.  5 , 2X)  7 

17) 
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*1*  n»HftT(liy,:^(xl2.?f?.X)/?X,"OF'3V=  ‘*»3(El?.?»r*X)/,llX,  3(E12.5|2X)/ 

</) 

as  C;UL  MATilCMft,SEE?S,SFE'=SA,3,3,3) 

E*n 

SMIPOUTINE  ^E^SU‘^e 


♦SU-T>OljriNE  NEAS’J  -^ALCJUATES  the  PAN:,E,PAnr,F  PATE,A^IM'JT^, 

•AH3  "1.-JATION  AS  ' .AS'JPEf'  PY  THE  i^AOAi?  If  THE  A/CfAHO  AOSS  NOISE 
•TO  thEH. 

* •m»^m**»******-***9**4***1  ••*** 

CniHOM/TI‘'E»/T,  OT.TE.-'FFT  .H.KK 
rr  fHON/HOMI’iAL'X,  Y,7,VX,VYtVT,V 
''01H0M/SA''APy PO 

'•1  lHOM/MOISV4P/or4,o(iiM,C5  X'>N,TETR;i,»'lN,r2N,E3M 
''OlHON/flLA'K/-;  1A  (3,3)  i G;  H « ( 3 , 3 ) ,G  AMT  ( 3, 3)  , SF  ( 7 ,1)  ,S  A3  { 3 , 3)  t 
XLrTTC?,!)  ,OllTC’,l)  ,C'JTN(7,7)  ,OUTi^U(7,l)  , FO,  ACC  (3,  1)  , Y1 , V2  ,V3 
cshhon/log::/ho'’F2 
Lnr.ICAU  HC3E2 
WM»C. 

Ps^rti^T  (X*X+'Y»Y*7*'’) 

0- >=  (X*  VX«’V»7Y  + 7*V?)  /R 
«»StRaY/S1=T(X*X»Y»Y) 

TETAP.sZ/^ 

IF  (M00i2)  SO  TO  10 
CALL  NOIZE(PN,0 .,WN) 

1C  OMT  (1, 1)  ==>HM 

1-  (MOOEZ)  GO  TO  2C 
call  NOIT:(POH,C.,WN') 

20  0'ir(2,l)=R0mN 

I-  (HOOE2)  GO  TO  30 
CALL  HOI7E(os:PM,C . ,WN) 

30  0'IT(3,1)  sPSIRfWM 
IF  (MOO'2)  GO  TO  ^0 
CALL  NOIZE(TET=N, 0.,MN) 

UC  QMT(4,1)  =TETAP«-WH 
IF  (H00E2)  GO  TO  50 
gall  NOIIE  (Pl'J,  O.f  Wf) 

5C  0'JT(5,l)=Ff(i,i)+nN 
IF  (HOOEZ)  GO  TO  GO 
CALL  NOIZ- (F2H, 0. ,WN) 

60  0IJT(6,1)=SF(2,1)*WM  ' 

IP  (MOOE2)  GO  TO  rc 

CALL  NOIZE(F3N, O.tWN) 

7C  0')T(T,i)=SF(7,l)«.WN 
RETURN 
ENT 

S'HKOUTINE  p('.i,P) 

♦SU'»RC»ITTme  f calculates  the  ''ERIVATIYES  f.’EE'lFO  FOR  THE  EJ^ER 
♦INTFGpitioN  F0>»  SUTROUTIf'ES  TyuAMIC  UOHIUAL.ANO  SEfSTAT. 


rOHHON7EPElLCU/oSI,TETA  ,PHI 
roHnOfl/CONTpoL/XO,  SPTAC  ,OELTAC 
CO<MON/3v*!1mIC/gFTA,CEL':a,Q,ALPHA,L 
COHMON/MO«TNAL/X,Y,Z, vy ,VY,77,7 
CO  l»(ON/SE‘'STAT/<rFciSP(3,7)  ,SEPSV(3,3) 

CO  1NOM/SFUPP'’C/ SPIELS  (1.3)  ,SP2EP3  (1 , 3) » SF3EPS  (1 1 3) , S^EPS  « •»,  ?) 
S,SP£PSA(3,t)  ,nF'i7(3,3)  .*fmP5(.7,3) 
COHMON/N0IS7AN/^M,PPN,PSI?N,TETr.M,FlU,P2N,P3N 
rniHON/IMFnHA'/M(3,7)  ,H(.T,1),DN(3,3)  ,'>H(3,1) 
C01HO‘l/>)LAU<7C'IA(7,7)  , Gf  M A ( 7, 7)  ,G  AM^  ( 3, 7 ) , SF  ( 3. 1)  ,GA3  ( 3 , 3)  . 
3LTPT(7,V)  fCUT  (T  ,1)  ,CIJTK(7  ,7 ) , OUTRU  (7  , l)  , FO,  ACC  ( 3, 1)  , 71 , V2,V3 

roHMOM /Logic/ fooE2 

OTHENS/fOM  U{7->)  ,P(36) 

logical  HOnr;»  
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; "'•aL  LAH<J«,*iu,(.,‘n,»*A,«r,La,LJ,LIFT 

naTACn3-.<,f-,3)  , ClAs-S.Sl)  ,(  iris-7?.C)  » (LAs.379),  (LO>.0>99I  » 
nd-AMDAslO.)  t(*r)  = -?5.)  ,(r,s.3’.2) 
f ' le-  <FO»  IP,?0,10 

i i ' ' •Sin^OM'^THE  r cnp  '^'IT^OUTIME  TYtiAMIC 

I I IJ  n{l)=-NH»('J<l)-'?ETaC) 

o«?)  s-LA-lOf  * CK  ?) -0‘=‘LTAr) 

, 0(Y)='n*'JCJ)*  IA«'Jt<,)^MO*U(2) 

f ! '»(-‘)sH(3) -LA*U(^) -Lf'*UCC) 

Ls*</*(P(W)-U(3)  ) 

PE7URN 

• r'npotrTNE  f fo=  smtto'itine  sominal 

2C  “(DsiJCif) 

P(2)=U{5) 

0(^)sU(fi) 

CALL  mATM(CMA,';f,acC,3,3,1) 

P{*)»4C3 (1,1) 
e(5)sACS{2,l) 

P('>)  sA03(3,l) 

P'TUPS 

♦SU’T^'tiriNE  «=■  FOP  THE  SENSITIVITY  CALCULATIONS 
33  P<»)sU{16) 

P(T)=U(17) 

»0)=U(13) 

»(l0)sll(19) 

P(ll)»U(2C) 

P(12)»IJ(21)  . 

B(13)='J(22) 

®(l4)=U(27) 

PCt5)  = U(2i.) 

P(16)*-5F(2,l)  4^9F-P«A(1,1) 

P(17)=3e’(3,l)  ♦S‘^EPSA(l,2) 

0(18)=Se-EPSA  (1,  T) 

={t9)=SF (1,1) ♦SPE’Sa (2,1) 
o(?0)=S-EPS4 (2,2) 

P(21)  = -S'^(T,1)  ♦SFFPfA  (2,3) 

»(22)=S-EPSA (3,1) 

»(23)  = -SF(l,l)  ♦£F-^PSA(3,2) 

P(  24)*S- (2,1)  ♦S'=’FPSA(3,3) 
no  130  1=1,3 
*‘(33«'I)»nH(I,i) 
on  139  J=!,3 
P(21*I>3*J) =0M( I,J) 

130  CONTINUE 
®ETUPN 
EMO 

SMIROUTIN'’  SENSO'IT 

•S'JTPOU'^INE  SENSO’JT  CALCULATFS  THE  OUTPUT  (PAOA’  MEf  SUPEn*  NTS  AMO 
•SPECIFIC  FORCES)  SENSI'^IVITIcS  W.p.T.  THE  HISAt.IGMHENT  ANCLES, 


rni''CN/TI''F2/T,r'T,TP,OPPTj?J,« 

cn  inon/mo'*'Thal7X,  Y,7,yx,vY,  v7,  V 

rn<N0N/SENS'^aT/n--?SF(3 ,2)  ,SrPSV  (3,3) 

rnN‘10M/SENSPn^/ipros<i,2)  ,S-iOEOS(l,7)  , jPSPEPS  ( 1 , 3) , STER£PS(  1 , 3) 
CO<‘«OM/SE»SFi'.C/S"  1EP3(  1,3)  ,3'2EFS  (1 , 3 ) ,SF3EPS  (1 , 7)  , SFEpS  ( 2,  3) 
1,P“=SA(3,7)  ,nP‘'V(3, 5)  ,TE»-P;(I,3) 
rnNMON/aLa*(«/C*fA  (3,3)  ,G/va  (3,3)  ,CAHF(3,7),SP(.?,1)  ,GA3(3,  3), 
1LI-T(3,1)  ,r'UT<7,l)  ,CU7N(7,7)  ,0UTPU(7, 1)  ,Fn,ACC(3,l)  ,V1,V2,V3 
OINENSION  PP(1,3) ,VP(1,3)  ,XY(1,3) , XYZ  (1 , 3 ), TEMPI ( 1,3)  ,TENP2(1,3) 
PanUT(l,l) 

P^dfDsX/P 

»?(1,2)=Y/P. 

P9(l,3)=Z/P 

PyP* (X»VX*Y* VY»7*V?)/ (R*P) 

VP(1,1)=  (VX/F.-»-/?-»PB.(l,l)  ) 
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V0(1,I)={V7/P-07?'PF (1,3) ) 
raUL  HAT^1(“=,'•.'^=';P,'OcP^,  1,3,3) 

CALL  ‘lATH(V'5,';f'P3=',TSM01,l,3,3) 
rAUL  MAT‘1(PP.,S£P'5«/,TEMP?,1,3,3) 

O')  10  1*1,3 

SPPcOSd,!)  *T^iPl  (1,1)  ♦TEMP2(l,I) 

10  CO  ITINUE 

XY(l,l)»-X*Y/SOPT( (y*X*Y*Y)**3) 

XY(l,2)sX*X/S')^T(  (X*X*Y*Y)**3) 

XY(1,3)»0. 

CAUL  '1ATi(XY,5EPSP,SPSRFPS,l,3,3) 

XY2(1, 1) =-X*7/R**  5. 

XY2(l,2)*-YrZ/^**  3. 

XYT(1,  3)s(X‘'X4.Y‘Y)/P*»3 

call  •(ATM(XYZ,SEPSP,3TFREPS,l,3,3) 

no  20  1*1,3 

SPlEOS(l,I)=‘?P"?':(l,I) 

SP2  EP<;  (1 , 1 ) * «;i=’e  PR  ( 2 , r ) 

SF3EPS  (1,I)*SPEPS (3,1) 

20  CO'ITIMUE 
RETURN 
ENI 

SUBROUTINE  NOrZE  ( RNSNOIE ,OUTN£AN ,WN) 

♦SUBROM-'TnE  nOIZE  calculates  the  VALUES  OF  THE  HEASUREMENT  NOISE 
♦COMPONENTS  USING  A RANOOH  NU’OER  GEMERATOP.  /OOELLEO  AS  GAJSSIAN, 


COiNON/NOISV A R/RN, RON, PS :RU,TETaU,FlN,F2N,F3N 
COMNOU/RLAUX/CiAC?,?) , GTH A ( 3, 3) ,G AHC ( 3, 3) , SF ( 7, 1) ,G A3  (3 , 3)  , 
ALIPT(3,1) ,0JT(3 ,1) ,OUTN(7,7) ,0UTRU(7,1) ,FO, ACC(3,1)  ,Vl,V2,V3 
GAUSS* 0. 

00  10  1*1,12 

r.AUSS»GAUSS*RANF{OUH) 

10  CONTINUE 

GA'ISS*GAUSS-6.  >OUTHEAN 

HN=6AUSS*F.MSN0IS 

PETURN 

ENO 

SUBROUTINE  INFOMAT 

♦SUBROirtUE  INFOHAT  CALCULATES  THE  VALUES  OF  THE  INFORMATION 
♦matrix  ANO  gradient  VECTOR  DCRENENTS. 


C')NNON/TIMER/T;nT,TF,OP'T  ,N,KX 
C01N0N/EPSTRUE/PSIT,TETr.T,PHlT 
CO  (NON /EPS :0/RS 10, TETAO,PHIO 

COiMON/SEMSCOR/SRtPR(l,3)  ,SROE?S(l,3)  ,SOSREPS ( 1 ,3)  , 5TERE OS ( I , 3) 
COHNOM/SENRFRC/SFlEPsd  ,3)  ,SF2EPS  (1 , 3 ) , SF3EPS  (1, 3)  , S^EBS  (3,3) 
1,SPEP3A(3,3)  ,nPnv(3,3)  ,*FH?'5(3,3) 

CO 1N0M/INFChAT/h(7,3) ,H(3,l),nN(3,3),?H(3,l) 

C01MON/9La‘!K/C  »A(',3)  , Gt  HA  (3 , 3 ) ,CAMF  ( 7, 3 ) , SF  ( 3 , 1)  ,GA3(3, 3), 
SLIFT(3,1) ,OUT(T ,1) ,CUTN(7  ,7) ,OUTRU(7 , 1) , FO , ACC (3, 1) , VI,  V2 ,V3 
A,SOUT£PS(7,7) 

C0MN0N/L0GIC/H00E2 
REAL  H 

LOGICAL  NOOE2 

OUENSIOM  30iiEPST(3,7)  ,TENPl  (3 ,7)  , OOUT  (7 ,1) 
no  10  1*1,3 

SO’JT£OSU,I)  *SRFPS(1 ,1) 

SOUTEOS(2,I) =3PPE?S(1,I) 

S0)TEPS(3,r) =SPSRcPS(l,I) 

S0UTEOS(i»,T)  sSTEPE?S(l,I) 

SOUTEPS(5,I)=G^lEPS(l,I) 

SOJTEOS(6,I)  sSREEf’Sd,!) 

?0'JT£PS(7,I)  =CP3'^PSd,l) 


i 

1 
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10  comtimue 

00  20  IslfT 

no  20  J=l,3 

S0‘IE«»ST<J,I)  sSOUTEPSd.J) 

20  CONTINUE 

CftLL  HT‘l(SOUE’>ET  ,0UTH,TEMP1,3|7,7) 
CALL  MAT'KTcH'^l  ,$OUTEPS,OM,3,7,3) 
no  30  1=1,7 

notlTd.DsO'JTTild.D-OUTd.l) 

35  CONTINUE 

CALL  MAT*1{T?*ioi,ooU7,OM,3,7,l) 

RETURN 

ENO 

SUORO'JTINF  EULTNT(U,K,OT) 

OI-IENSION  'J(3j),P(3t» 
call  F(U,P) 
no  10  J=l,< 

U(i)=U(J) ♦O(J)*0T 
10  CONTINUE 
RETURN 
FNO 

SinPOUTINE  math  (1,8, C,N,K,N) 
OTNENSION  A(N,<),0(K,N),C(*1,N) 

00  10  J=1,N 
no  10  1*1, N 
C(ItJ)=0. 

00  13  L=l,< 

C(I,  J)  »Cd,J)  tAd.D’aCLtJ) 

10  CONTINUE 
RETURN 
ENO 
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♦OF 

* 


P^OGRAI  SIMULI (IMPUT,OUTPUT=100?9,TflPE5=10023,TAPei3=OUTPUT) 

» tl.4.  ifttJt.^tHHtt^it.4t*>f***4^************ 

♦PPOr.oftH  SIMJL  IS  A SIMULATION  OF  THE  TRACKING  AND  CONTROL  OF 
♦AN  AIP-TO-G^OUNO  MISSILE  USING  MAXIMUM  LIKELIHOOD  FSTIMATION 
THF  THREE  ANGLES  REPRESENTING  ITS  INITIAL  MISALIGNMENT. 

I C01M0N/TIMER/T,  OT.TFiOPPT 

/ common/epsilon/psi,teta,phi 

' COMMON/ EOSTRUE/PSITjTETATtPHIT 

COMMON/ EPSIO /PSIO, TFT AO, PHI  0 
COMMON/:ONTROL/KO,BETAC,DELTAC 
COMMON/ DYNAMIC /RET A, DELTA , Q, ALPHA, L 
COMMON/ NOMIN AL/ X,  Y, 7,  VX,VY,\/Z,V 
COMMON/INITIAL/XO, YO, ZO,VXO,YYO,VZO 
CO-IMON/SENSTAT/SEPSP  (3,3)  ,SEPSY(3,3) 

COMMON/SENSROR/SP£PS(l  ,7)  ,SRDEPS(1,3) ,SPSREPS (1 , 3 ) , 3T ERE  PS (1 , 3 ) 
C0MM0N/N0ISVAR/RN,R0N,FSIRN,TETRN,F1N,F2N,F3N 
COMMON/INFOMAT/M(3, 3) , H ( 3 , 1) , OM (3 , 3 ) , OH ( 3, 1 ) 

COMMON/ blank /CM  A (3,3) ,GAMA(3,3),GAME(3,3),SF(3,1),GA9(3,3), 

'(LIFT  (3, 1)  ,0JT{7  ,1)  ,0'JTN  (4,4)  , O'JTRU  ( 7 , 1 ) ,F0  , ACC  ( 3, 1)  , SO'JT  EPS  ( 4 , 3 ) 
COMMON/LOGIC/iMOOEI 
LRGICA.  MOnEl 

OIMENSTON  U(3G) ,MKAPEA (18), MI (3, 3), TY ME (6), OELTOUT( 18,4) ,HOTOUT( 
<18,4) ,rRD(18)  ,0«SI(13)  ,nT ET A ( 1 8) , OPHI (1 8 ) , PSIP ( 3) ,TET A® ( 3) , PH  IP 
< (3)  , DO'JT  (4,1),H0T(4),TAVLCR(4,1),EPS(3,1) 

®EAL  M, LIFT, L, Ml 

4.  44  444.444444.44444*4*4**4*****44 

♦initialization  of  THE  RANDOM  NUMBER  GENERATOR  FOR  NOISE  GENERATION. 

* 444*444444444‘444444*44444444* 

o®INT(10 ,98) 

J )=1 

CALL  RANSFT(jj) 

T=]  . 

nPRNT=3. 

PRINTS,  ••♦♦♦TRUTH  MOPEL  ♦♦♦** 

MO')El  = . false. 

4 4444444444444*4444*4*444****** 

♦INITT ALIZATION  OF  THF  MISALIGNMENT  ANGLES  WITH  VALUES  ASSUMED  TO  RE 
♦TRUE. 

4 44**44*44*44**444*44********** 

®ST=PSIT 

■'fta=tetat 

PHI = PHI T 

AOSI=ATETA=APHI=0 . 

44444441I.4444494444444444****** 

definition  Df  the  MISALIGNMENT  ANGLES  TRANSFORMATION  MATRIX. 


:ma  = 


1. 

OSI 

-TETA 


-PSI 

1 . 

PHI 


TETA 

-PHI 

1. 


ms  MCB  IS  BEST  QUALITY  PBACTIflWM 


L 


CMA (1,1)  =CMA (2, 2) =CMA (3,3)  = 1. 

CMA (2,1) =PSI 
C'M  (3,1)  s-TETA 
CMA (3,2) =PHI 
CMA (1,2) =-CMA (2,1) 

CMA (1,3) =-CMA (3 ,1) 

CMA(2,3) s-CMA (3,2) 

♦INITIALIZATION  OF  POSITION , VEL OCITY , AND  SPECIFIC 

X=XO 

Y=YO 

7=70 

- 


FORCE. 


narti 


CMA  (1,3)  =-r;MA(3,l) 

CMa(2,3)  =-r*1fl  (3,2) 

♦INTTTALTZATION  0^  POSITION , VFL OCITY , AND  SPECIFIC  FORCE. 

x=yo 

Y=VO 

7=70 

2VX=YX0 
VY=VYO 
V^=7Z0 

V=SORT(  YX*  VX  + VY*VY«-VZ*V7) 

SF(1,1)=0. 

SF(2,1) =0. 

SF(3,1) =0. 

♦EVALUATION  OF  THE  VALUE  OF  THE  STATES  FOP  THE  TRUTH  MODEL  . 

10  CALL  MEASURE 

WRITE (5 ) T, (OUT (1,1) ,1=1,7) 

CALL  CONTROL 
Fn=-1. 

CALL  DYNAMIC 
FD=0  . 

CALL  NOMINAL 
CALL  SPFORCE 

20  IF(A9S(r-DPRNT) .LT.1.E-C6)G0  TO  40 
30  t=t+DT 

IP{T.LE.TF)GO  TO  10 
CO  TO  30 

■,0  PRINT(10,9P)KO,  BET  A,  DEL!  A ,C,  ALPHA  ,L  , X , Y , Z,  V , VX,  VY,  VZ , T , 9ETAC, 

^OELTAC,  SR(1,1)  ,SF{2,1)  ,EF  (3, 1 ) ,OUT  ( 1 , 1)  ,OUT  (2 , 1)  , OUT  ( 3 , 1 ) , OUT  (4 ,1 ) 
3,  ACC  (1,1) , ACC (2,1) , ACC (3,1) 

PRrNT(10,79)T,(nUT(I,l) ,1=1,7) 

DPRNT  = 0PRNT«-DPRT 
GO  TO  30 
BO  REWIND  5 

RRINT^, ••♦♦♦MODEL  !♦♦♦•• 

MOOE1=.TRUE. 

PRINTS,  ••MOOEl=^^,MODEl 
PSI=PSIO 
TETA=TETAO 
PHIsPHIO 
DO  110  NN=1,3 
N-IN 
1=0. 

OPRNT=0. 

♦initialization  or  thp  misalignment  angles  WITH  FIRST  ESTIMATED 
♦NOMINAL  VALUES. 

4 444444444444444444444444444 444 

PSI=PSI^APSI/1000 
TETA=TETA+ATETA/l-:00 
FHIsPHIfAPHI/lOOO 
PSTP(N) =1COO^OSI 
TETAP(N)  =1000^TE'^A 

PHTP  (N)  = 1G00*°HI  ms  PAOK  IS  BBS!  QUALITY  FIUiOXIAAKil 

CMA  (1,1)  =CMA  (2,  2)  =CMA  (3,3)  = 1.  ranM  nnow  gwar.  m nnn 

CMA(2,1) =PSI 

CMA (3,1) =-TETA 

CMA (3,2) =PHT 

CMA (1,2) =-CMA (2,1) 

CMA(1,3) =-CMA(3,l) 

CMA (2,3)=-CMA(3,2) 

4 444444»444444444444 44444444444 

♦INITIALIZATION  OR  POSITION , VELOCITY, SPECIFIC  FORCE , AEPOOYNAMI C 
♦VALUES, INFORMATION  AND  DISPERSION  MATRIX  ELEMENTS  ANO  TRACE, 


3 


*INITIflLI74TrDN  OP  POSITION ,VFLOCITY, SPECIFIC  FORCE , AEPOOYNAMI C 
♦VALUES, INFORMATION  ANO  OISPEFSION  MATRIX  ELEMENTS  ANO  TR4CE, 
♦ANO  SENSITIVITIES. 

U(l) =xo 
tJ{2)  =Y3 
U(T) =10 
U(^) =VXO 
U(5) =VYD 
IHS)  =VYO 
U(S) =V70 
Sc-(1,1)=0. 

SP(2, !)  = (]. 

SP(3,1)=0. 

BETA=0. 
nELTA=0. 

0='], 

ALPHAsC. 

L=3. 

DO  1=1,3 
00  55  J=l,7 
«fPoSP(T,  J)  =0. 

S'^=»3V(I,  J)=0. 

M(I,J)=0. 

MT(I,J)=0. 

5S  CONTINUE 

DO  60  1=7,36 
U(T)=0. 

60  CONTINUE 

nUTN(l,l) =1./ (RN»RN) 

OUTN(2,P)=l./(RON»RnN) 

OUTN (3,3) =1,/ (OSIPN^PSIPN) 

OUTN (4,L) =1 ./ (TETRN^TETFN) 

OUTNd,?)  =o'JTN(  1,3)  =OUT)  ( 1,4)  = 0, 

0UTN(2,1)=0UTN{2, 3) =CUTM (2,4) =0. 
0UTN(3,1)=0UTN(3,2)=0UT^'(3,4)  = G. 
OUTN(4,1)=OUTN(4,2)=OUTN(4,3)=0. 

00  100  <<=1,5001 
REA 0(5)  T,  (OUTR'J(I)  ,1=1,7) 


STATES  DEFINITION 


♦POSITIONI (1-3) 

♦ U(1)=X, 
♦VFLOCITYt (4-5) 

♦ U(4)=VX, 


U(2)=Y,  U(7)=7, 


'J(5)=VY,  U(6)=V2, 

♦POSITION  SENSITIVITYt(7-15) 

♦ U(7)=X/PSI,  U(8)=X7TETA, 

♦ U(10)=Y7PSI,  U(11)=Y7TETA, 

♦ U(13)=Z/PSI,  U(14) =Z/TFTA, 

♦VELOCITY  SENSITIVITY »( 16-24) 

♦ U(16)=VX/PSI,  U(17)=VX/TETA, 

♦ U(19)=VY/PSI , U(20)=VY/TETA, 

♦ U(?2)=VZ/PSI,  U(23)=V7/TETA, 

♦INFORMATION  MATRIX! ( 25-37) 


U(9) =X/PHI, 

U(12)=Y/PHI, 

U(15)=Z/PHI, 


U(18)  =VX/PHI, 
U(21)=VZ/PHI, 
U(24)=VZ/PHI, 


♦ 

U(25) 

U(28) 

U(31) 

U(25) 

U(29) 

U(32) 

U(27) 

U(30) 

U(37) 

♦TRANSPOSE  OF  SRAOIENT  VFCTOR I ( 34-36) 

♦ H=  U(34)  U(35)  U(36) 

• 

X=U(1) 

Y=)(2) 

7='J(3) 

VX=U (4) 

VY=U(5) 


3^  OQj^X  IHRPWSHB!)  IQ  MiQ 


SBIS  PA(SE  18  BEST  QUALITY 


Z=IJ(3) 
VX=U  (4) 
VV=U(5) 
V7=U(6) 


JHIS  F&Ql  IS  BIST  QUALlIT  FRAiCriCABLS 
roOM  0(tf*Y  FURStlSiOS)  ‘mnng 


♦USING  TNE  RE:EItfEO  SPECIPIC  FORCE  ftS  INPUTS  TO  NOTFL  1 


no  ZO  1=1,3 

SF(I  ,1)=0U’RLJ(I«-4) 

70  CONTINUE 

CALL  MEASURE 
DO  30  1=1,3 
DO  80  J=l,3 
SE»SO(I,  J)=U (3»I  + J + 3) 

SEoSVd,  J)=U  (3*I+J*12) 

30  CONTINUE 

TP( (K<-1)  -10  0 0* ( (KK-1) /10  00) .EO.O) PRINT (10 , 67 ) ( (SE^SP ( I , J ) , J = 1 , 3) 
^1=1,3)  , ((SFPSV{I,J) ,J=1,3),I  = 1,3) 

CALL  SENSOUT 
CALL  IN-OMAT 
no  65  1=1,4 

nOUT(T,l)=OUTRU (1,1) -OUT (1,1) 

65  CONTINUE 

(1,1) =PSIT-PSI 
EPS(2,1) =TETAT-TETA 
E°S(3,1)=PHIT-PHI 

CALL  MATH(S0UTEPS,EPS,TAYL0R,4,3, 1) 

DO  75  1=1,4 

HOT ( I) =DOUT( 1,1) -TAYLOR (1,1) 

■•D  CONTINUE 
PD=0  . 
t<=36 

CALL  EULINT(U,K,  .01) 

IE(  (<K-1  ) -10  0 0*  ( (KK-1) /lOOO)  .EQ.0)PPINT(10,81)DOUT,3DT 

IF(  (KK-1)  - lOOQ* ( (KK-1) /lO  GO) .EQ.O )PRINT (10, 79) T, (0UTRJ( I)  ,1  = 1 ,7) 

TF(  (KK-1) -10  00* ((KK-1)/10  00  ) .NE.0)GO  TO  83 

TY1E( (KK-1)  /100  0*1) =(KK-1)/100. 

no  8 2 1 = 1,4 

DEL  TOUT ( (6* (N -1 ) + (KK-1 ) /I  000*1 ) , I ) =DOUT ( I, 1) 

HDTOUK  (5*(N-1)  *(KK-1)/1C00*1),I)  =HOT  (I) 

32  CONTINUE 

33  no  90  J=l,3 
DO  90  1=1,3 

M(I, J) =J{21*I+3*J) 

90  CONTINUE 

T'=‘(KK.E').1)30  to  100 

IF((KK-1)-1C00* ((KK-1)/1CC0) .NE.0)GO  TO  100 
CALL  LINV2F(M,7 ,3,MI,10,WKAREA,IER) 

TPD(6* (N-1) ♦ (KK-1) /100  0*1  )=MI (1 ,1 ) ♦«!  (? , 2) ♦ MI  (3 , 3 ) 
nPTNT(10,78) TRD(6* ( N-1 ) + ( KK-1 ) / 10 00 *1 ) 

APSI=(MI  (1,1)*U  (3^*)  *MI  (1,  2)*U(35)  *MI  ( 1,3)  *U(3F)  )*1000 
ATETA= (MI (2,1) •1X34) fMI  (2,2 )*U (35) ♦mi (2, 3) *0(36)) *1000 
APNI={MI (3, 1)*U (34) ♦MI  (3, 2)*U(35) ♦MI (3,3)*U(36))*ia00 
nPSI (5*(N-1) ♦(KK-1) /100r*l)=( PSIT-PSI) *100 0-APSI 
n7=TA(6* (N-1) ♦( KK-1) /1000*1)=(TETAT-TETA)*1000-ATETA 
OPHI (6* (N-1) ♦(KK-l) /100C*1)=(PHIT-PHI)*1000-APHI 
PPINT(10,92) KD, N, OPSI (6* (N-1) ♦ ( KK-1 ) / 10 0 0*1 ) , DTET A ( 3 • ( N-1 ) ♦ 

^ (KK-l) /100  0*1) , nPHI (6*  (N-1) ♦(KK-1  )/ 10  00 ♦!) 

100  CONTINUE 
REMIND  5 
lie  CONTINUE 

PSITP=10a0*PSIT 

tetatp=iooo*tetat 
phito=iooo*phtt 
no  15  N=l,3 

PRINT ( 10, 1) PSITP,T ETATP, PHITP, PSI P (N ) ,TETAP(N) ,PHI0(N)  ,N 

1 PORMATC’l  MODEL  I"  ,5X  ,”EPSITRUE=** , 2 ( El  2 . 5 ,",")  , El  2.  5 ,/3  X, 


wot 


14.4:' 


5. 


J CONTINUE 
•’ENINO  5 
3 CONTINUE 

PEITP=100C*PSIT 

tetatp=iooc*tetat 

PMITD=1000'^PHTT 
no  15  N=l,3 

PPTNT(10,1)PSITO,TETATP,PHITP,PSIP(N) ,teTAP(N) ,PHIO{N) ,N 
L '^OPNATC’l  NOOEL  1 " , ?X  ,"EPS  ITRUE  ="  , 2 ( El  2 . E , , El  2 . 5 , /3  X, 

^••WITH  N0IEE",5X,"FP?I0=  " , 2 ( El2  , El  2 . 5 , /3  X,  "<0  = 3", 

^'^X, "ITERATION  ",I1,///) 

PRINT (10, 2) 

? PQRNAT  (4X,"TIME",  <SX  ,"nELTA(R)  ", 7X  , "HOT (R )", 6X  , "DELTA  (RO)  ", 
nf'X,"HOT(RO)  "/) 

no  4 1=1,6 

“PINT  (10, 3)  TYNE  (I)  ,rELTOUT(  ( 6*  ( N-1 ) +1 ) , 1 ) , HOTOUT  ( (6*  (N-1 ) «•!)  ,1)  , 
^n^LTOUK  (E»(N-1)+I)  ,2)  ,HOTOUT  ( (6*  (N-1)  ♦!)  , 2) 

♦ CONTINUE 

5 FORNAT (4X,F4.0,hX,2(E12.5,2X),2(2X,E12.5)/) 

PRINT (10, 5) 

■ FORMAT ("0",3X, "TIME", 5X, "CELT A (AZ.) ",5X, "HOT (AZ.)  ",7<, 

^"OELTA (EL.)  ",5X,"H0T(£L.) ",/) 

no  6 1=1,6 

PRINT  (10, 3)  TYME  (I)  , PELTCUT(  (6*  ( N-1)  +1 ) , 3 ) , HOTOUT  ( (6 '^  ( N-1 ) +I ) , 3 ) , 
KnFLTOUT(  (6*(N-1)-H),4)  ,HOTOUT(  (6*  (N-1  )4-I)  ,4) 
b CONTINUE 
PRINT(10,11) 

I FORMAT (6X, "TIME", 5X, "TRACE  OF", 6X , 3 (AHEST IMATE, 4X)  /15X, 

^"nTSPERSI0N",6X,3 (8HERRCR  IN , tX ) / 17X , "MATRI X" , lOX ,"*51" , 
?qX,"TPTA",8X,"PMI"/) 
no  12  1=1,5 

PRINTdO,  13)  TYMF(I)  ,TR0(6»  (N-1)  ♦I ) ,OPSI  (6»  (N-1  )♦!)  ,0TETA 
^ (5*  (N-1) +1)  , 0PHI(6*  (N-1)  ♦!) 

? CONTINUE 

! FORMAT (5X,F4. 0,5 X,E12. 5,3 (3X,E9.2)/) 

5 CONTINUE 

^ PORMAT (lX,"TPn=",Pl?.5/) 

' PORMAT (IIX, 3 (E9 .2, 2X)/3X, "SEPSP=  ",3(E9.2,2X)/11X,3(E9.2,2X) 
^//11X,3(E9.2,2X)/3X,"SEPSV=  ",  3 ( E9 . 2 ,2 X) /IIX , 3 ( E9. 2 , 2< ) //) 

) FORMAT (lX,5HnUTRU=,F6. 3,4  (2X, E9,2 ) /13X, 3 (2X , E9 .2) 7/) 


V'PAf  >»Af  icir\  $ r \ f huoa  Jtaj  c.  9 f 9 

X"ACC3",//) 

FORMAT (5X,I1,5X ,5 (ElO. 3,1X) /1X,7(E10. 3, IX) /1X,F6. 3,5X,  2 (EIC. 3, IX)  , 
*;11X,3(E10.'*,1X)  71X,7(E1C.  3,1X)//) 

STOP 


9L0CK  DATA 
RPAL  L,M 


RPAL  L,M 

nOMMON/TIMFR/T,OT,TF,OPFT 
C01M0N/EP5TRUE/P5IT,TETAT ,PHIT 
rO‘1MON/EPSIO/P5IO,TFTAO,PHIO 
C01MON/CONTROL/xn, BFTAC,OELTAC 

common/oynamic/peta,oelta,q,alpha,l 

C01MON/INITIAL/XO,YO,ZO,VXO,VYO,VZO 
C01MOr:/3ENSTAT/SEOSF(3,7)  ,SEPSV(3,3) 
C01M0N/N0I5VAR/RN,PPN,P?IRN  ,TETRN, FIN, F2N, ' 
COMMON/INFOMAT/m (3, 3) , H(3,l) , OM ( 3 , 3) , OH ( 3, 
HATA  OT,TF,npRT/.01,50.,lC./ 

HAT A P5IT,TETAT ,PHIT/1  ,F-G3, 2. E-J 3, 3. E-0  3/ 
DATA  OSIO,TPTAO,PHIC/3*C./ 

DATA  <0/3/ 


OKS  P*0  K 

jjgQII  ooPY  FURNISH® 


CO1H6H/0YNftMIC/»?ETA,0ELTA,Q,ftLPHA,L 
C01M0N/INITIAL/X0,YO,Z0fVX0,VY0,VZ0 
CniM0N/SENSTAT/SEPSP(3,3) ,SEPSV{3,3) 

C01M0N/M0ISVAR/RN,RnN,PEIRN ,TETRN, FIN, F2N,  F3N 
CO'^MON/INFOMAT/M  (3, 3)  , H ( 3 , 1)  , DM (3 , 3)  , OH ( 3, 1) 

/ HATA  OT,TF,OPRT/,01,50.  ,1C./ 

/ HATA  PSIT,TETAT ,PHIT/l.E-C3,2.E-a3,3.E-03/ 

(x  oata  pSI0,TFTA0,PHI0/3*C./ 

DATA  KO/3/ 

data  beta, helta.q, alpha, L/5*0./ 

PAT A XO, Y0,70, VXO, VYO, VZO/2*100C. ,10C .,2000. , 1500., 10./ 

PATA  SEPSP,SEPSV/18*0./ 

DATA  RN,RDN,PSIRN,TETRN,F1N,F2N,F3N/1G. , 10. ,2*. 001, 

^3*32.2E-03/ 

PATA  M,H/9»0 . , 3*0  ./ 

ENP 

S'JIROUTINE  CONTROL 

♦SUBROUTINE  CONTROL  GENERATES  THREE  TYPES  OF  COMMANDS  FOR 
♦DELTA  AND  BETA. 

4.  444444444444444444444.444444444 

Cn-IMON/TIMr^/T,  nT,TP,OPPT 
CO'1MON/CON‘^ROL/KD,BFTAC,DELTAC 
REAL  <l,K2,K3,Kt‘ 

data (<1= .063) , (K2=.  03)  , (K3=.007) , (KL=,002) , (Wl  = .l) , (W2=. 2) 

TC=T+0T/2. 

IF(KD. EQ.l) 10, 20 
10  nELTAC=<3«-!<it»SIN(W2^TC) 
qPTAC=Kl*TC 

20  TF(KO.FQ.2)30,40  gg  W IS  BBST  QUALtlY  PBAiArrritiT.lf 

30  nELTAC=<3  Wl lAJiaaaHBD  Tn nnn' 

BETAC=K1»TC^K2^SIN (Wl^TC)  

RETURN 

UO  BETAC  = K1^TC<-K2^SIN  (Wl^TC) 
nELTAC=<3*K4»SIN(W2^TC) 

RETURN 

PND 

SUBROUTINF  DYNAMIC 

4 44  444**4¥*-¥******************* 

♦subroutine  dynamic  CALCULATES  THE  VALUES  OF  BETA, DELTA, D (PITCH 
♦RATE), ALPHA  (ANGLE  OF  ATTACK), AND  L (LIFT)  BASED  ON  AN  EJLER 

♦INTFGPnrIQ^J  (ROUTINE. 

4 44  444  44*  ****  ****************  **** 

CO^MON/TIMER/TjOTjTF.OPFT 
COMMON/3 YN AM TC/ 9FT A, DFL^A ,Q, ALPHA, L 

COMMON/BLANK/CMA (3,3) , GAM A (3, 3) ,G AMF ( 3, 3 ) , SF ( 3, 1 ) ,GAB ( 3 , 3 ) , 
nLIPT(3,l)  ,OJT(^,l)  ,0UTN«»,4),0UTRU(7,1),F0,  ACC(3,1)  ,S0UTFPR(!,,3) 
DIMENSION  U(4) 

REAL  L,LIET 
U(1)=BETA 
U(2) =DELTA 
U(3) =0 
U{4)=ALPHA 
GAD(1, 1) =1. 

GAB  (2, 2)  =GAB(3,3)=COS(U(l)) 

GAB  (3,2) =SIN {U( 1) ) 

GAB(2,3)=-GAB(3,2) 

GAB (2, 1) =GAB(1, 2) =G AB ( 3 , 1 ) =GAB ( 1 , 3) =0. 

K=f 

call  EULrNTd),^,.^) 

BETA=U (1) 

DELTA=U(2) 

Q=’)(3) 

AL'’HA  = U(4) 

PFTURN 

FND 

SUBROUTINE  NOMINAL 


»<=l» 

CALL  EULINT(U,K, .01) 

BETA=U (1) 

0ELTft=U(2) 

Q=|J(3) 

7AL3HA  = U(<») 

RETURN 

FNO  ^ 

SUBROUTINE  NOMINAL 

♦SUBROUTINE  NOMINAL  CALCULATES  THE  VALUES  OF  THE  MISSILE  POSITION 
♦ANO  VELOCITY  IN  THE  A/C  FRAME, BASEO  ON  AN  EULER  ROUTINE. 

* 4.^.^4.  If  If  If  ^if  tflfif  IflftH-^^ifif  ******* 

COMMON/TIMER/T, OT,TF,OPRT 
COMMON/E PSIL ON/ PSI,TET A, PHI 
COIMON/NO'^INAL/X,  Y,Z,  VX,  VY,  VZ,  V 

COMMON/3LANK/CMA(3,3) ,GAMA(3,3) ,G AME ( 3, 3 ) , SF ( 3 , 1) ,GAB(3,3), 

'^LT'^’T  (3,1)  ,OUT(T  ,1)  ,OUTN  (4  ,4 ) , OUTRU  (7 , 1)  , FO , ACC  ( 3, 1)  , SOUTEPS  (4,3) 
niMENSION  U(B) 

U(l) =X 
U(2) =Y 
U(3)=7 
U(4) =VX 
U(S) =VY 
U(S) =VZ 
K=S 

CALL  EULINT(U,K,.ai) 

V=SORT (U(4) *0(4) +U(S) ♦U(5)+U(6)*U (6) ) 

X=!»(l) 

Y=U  ( Z ) ?AGm  Z<S  BBST  QUALZnfRjAtCiriji^AA&l 

Z=U(3)  raOiM  OOiPY agflBC 

VX=U(4) 

VY=U(5) 

V^=U  (&) 

RETURN 

PNO 

SUBROUTINE  SPEORCE 

* ****************************** 

♦SUBROUTINE  SPEORCE  CALCULATES  THE  SPECIFIC  FORCES  MEASURED  BY  THE 
♦three  accelerometers  ON  THE  ^ISSILE. 

• ****************************** 

COMMON/TIMER/T, OT, TF, DPRT 

common/epsilon/psi,teta,phi 

CnMM0N/DYNAMIC/3ETA,nELTA,Q,ALPHA,L 
COMMON/NOMINAL/X, Y,Z, VX,VY,VZ, V 

C0'1M0N/BLANK/CMA(3,3)  ,GAMA(3,3),GAME(3,3),SF(3,1),GA3(3,3), 

».LTET  (3,1),  out  (7,1)  ,OUTN  (4,4)  ,0UTRU(7 , 1)  , FI) , ACC  ( 3, 1)  , SOUT  EPS  ( 4 , 3 ) 
OIMENSION  GA  (3,3) ,GAF(3,3) 

R’^IL  L,LIFT 

LrET(3,l)=-L 

LTeT(1,1)=LIFT(2,1)=0. 

Assort (vx^vx+vy^vy) 

Vl=VX+PSI*VY-TE7A^VZ 
V2=-PSI^ VX+VV+PHI^VZ 
V3=TetA»VX-PHI^ VY+V7 
GAMA  (1,1)=V1/A 
CAMA(2,2)=GAMA(1,1) 

GAMA  (1,2)=-V2/A 
GAMA (2,1) =-GAMA (1,2) 

GAMA  (3,3)=1. 

GAMA(1,3)=GAMA(3,1)=GAMA(2,3)=GAMA(3,2)=0. 

GAME(1,1)=A/V 

GAME  (3,3)=GAMr(i,i) 

GAME(3,1)=V3/V 

GAME(1,3)=-GAME(3,1) 

GAME(2,2)=1. 

GAME(1,2)=SAME( 2,1) =GAME(2,3)=GAME(3,2)=0. 


GRiACS.Ds-GftHAdjZ) 

Gft'IA  (3,3)=1. 

GAS A (1,3)=GAMA(3,1)=GAMP<2,3)=GAMA(3,2)=0. 
GASE(1,1)=A/V 

GASE(3,3)=3Amf(i,i) 

GASE(3,1)=V3/V 

GASE(1,3)=-GAME(3,1) 

GASE(2,2>=1. 

GA-^E  (1 ,2)  =GAME(  2,1)  =GAMr(  2,3)  =G AME  ( 3 , 2)  = 0 . 
GALL  MATH(GAMA,GASE,GA,3, 3,3) 

CALL  MATS(GA,GAP,GAF,3,3, 3) 
call  MATS(GAF,LI»=’T,SF,3,3,1) 

Rf^TURN 

EMT 

SII3R0UTINE  SEA'^URE 


♦SUBROUTINE  MEASURE  CALCULATES  THE  RANGE, RANGE  RATE , A 71 MUT H , 
♦ANO  rLP’^ATlON  AS  MEASURED  9Y  THE  RADAR  IN  THE  A/C. 


COSMON/TIMER/T, nT,TF,OPFT 
COSMON/NOMINAL/X,  Y,7,\/X,  VY,  VZ,  V 
CO1M0N/N0IS\/AR/RN,RDN,PSIRN,TETRN,F1N,F2N,F?n 
r0SM0N/3LANK/CMA(3,3) , GAMA (3, 3) , GAME ( 3, 3 ) , SF ( 7, 1 ) ,GA3(3, 3), 

^LI^T  (3,1)  , 0UT(7,1)  , OUT  N (<♦,*♦)  , OUTRU  (7 , 1 ) , FO  , ACC  ( 3, 1)  , SOUT  EPS  ( t» , 3) 
COMMON/LOGIC/MOOEl 
logical  MOOEl 


•» 


1? 

20 

30 

40 

50 

oO 


WN=0. 

R=SQRT  (X^X*Y*Y«-Z»7) 

RO=  {X*VXfY*\/Y-*-7^V^)  /R 
oSIR=Y/3QPT (X*X4Y*Y) 
TETAR=Z/R 

TF(MOOEI)  go  to  10 
CALL  NOIZE(RN,0.,WN) 

OUT (1,1) =R4WN 
T'=’(MOOEl)  GO  TO  20 
CALL  NOIZE(RDU, C.,WN) 
OUT  (2,  1)  =RD«-WN 
TF(MOOEl)  GO  TO  30 
CALL  NOIZF(PSTRN,0.,WN) 
0UT(3,1)=DSIR+WM 
T'^(MOOEl)  GO  TO  40 
CALL  N0I7E(TETRN, 0.  ,WN) 
OUT  (4, 1)  =TGTAR4-WN 
TF(MOOEl)  GO  TO  50 
CALL  N0I7E(F1N, 0 . ,WN) 
OUT(5,l)  =5*^(1, 1)+MN 
IF(MODEl)  GO  TO  60 
CALL  NOIZE('^2N,  0.  ,WN) 
O'r  (6,1)=SF(2,1)+HN 
IF(MOOFl)  SO  "O  70 
CALL  NOIZE(F3U,0.,WN> 
OUT(7,l)=S‘^(3,l)+WN 
'’'^TURN 
FNO 

SU3ROUTINE  F(U,P) 


IHIS  PAGE  IS  BEST  QUAIilTY 
roOM  OOPY  JURNISHEID  XOI^Q  . 


♦SUO'^OUTTNE  F CALCULATES  THE  DERIVATIVES  NEEDED  FOR  THE  EJ-ER 
♦INTEGPATION  ^0®  SUBROUTINES  DYNAMIC  NOMINAL, AND  SENSTAT. 


CO  1MOM /EPSILON/ oSI,TET A, PHI 
COUMON/CONTROL/<n,flETAC,CELTAC 
COMMON /DYNAMIC/ BET A , CELT A, 0, ALPHA ,L 
D01M0N/N0MINAL/X,Y, 7, VX,VY,V^,V 
D01M0N/SENSTAT/SEPSP(3,7) ,SEPSV(3,3) 
DOMMON/NOISVAR/PN,RON,PriPN,TETRN,FlN,F2N,F3N 
COMMON /I NFOMAT/m (3,7) , H ( 3 , 1) , DM (3 , 3 ) , DM ( 3, 1) 

COMMON /BLANK/CM  A (3, 3)  , GAM  A (3, 3)  ,G  AME  ( 3, 3 ) , S F ( 3, 1 ) ,G  A ? ( 3 , 3 ) , 

„ ALIFT(3>i>»0iJT(7tl)  t0UTN(4»4),0UTRU(7,l)  ,F0,ACC(3,i),S0UTEPS(4,3) 


■u  rnunimicf  m » p’lTVii  f ri  | f iwisp^^pnipnn^mp 

C0iM0N/SENSTftT/SE:PSP(3,7)  ,SEPSV(3,3) 
ro>^•^ON/^^OISVflP/PN,RON,PfTRN,T£TRN,FlN,F2N,E3N 
COiMON/INFOMaT/MCSjS)  ,H(3,1),DM(3,3) , DH(  3,  1) 
CO'<HON/RLANK/CMA(3,3)  ,G/iMA(3f  3)  »G  AHE  ( 3t  3 ) » S F ( 3 1 1 ) y'^A 3 ( 3 , 3 ) t 
3LTFT(3,1)  ,0JT(7,1)  ,0UTN(4,4)  ,0UTRU(7,1)  ,Fn,ACC(3,l),S0UTEPS(«»,3) 
COMMON /LOGIC/^ODEl 
OTiENSION  LJ(3S)  ,P(36)  ,0IITF(3,1) 

LOGICAL  HOOEl 

PEAL  LAM0A,MU,L  ,Mr),MA,MP,LA,LO,LIFT 

nATA(MQ=-.462) , (MA  = -5.81)  , ( MDs -72 . C ) , (L A = . 3 79 ) i (L0=.CG99) , 
n (LAMOA=10.)  , (NIJ  = 30.)  , (G=32.2) 


25 


IF  (FO)  10,20,30 

♦SU9R0UTTNE  F FOR  GU^OOUTTME  DYNAMIC 
10  P(1)=-NU»(U(1>-RETAC) 

P(2) s-LAMOA* (U( 2) -DFLTAC) 
Pf3)=MQ»U(3> ♦MA»U(4)*MD*U (2) 
P(’4)  =U  (3)  -LA*U(4)  -L0*U  (?) 

L=-V* (P(4)-U (3) ) 

RETURN 

♦SURPOUTInE  F for  SU3R0UTINE  NOMINAL 
23  IF(MOOE1)GO  TO  25 
F(1)=U(4) 

P(2) =U (5) 

0(3)=U(6) 

CALL  MATM(CMA,SF,ACC,3,3, 1) 
R(4)=ACC (1,1) 

PC?)  =ACC(?,1) 

P(5) =ACC (3,1)+G 
o=’TURN 
P(l) =U (4) 

P(?) =U  (5) 

P(3)=U (a) 

0UTF(1,1)=0UT(5,1) 
nMTF(2,l)=OUT(6 ,1) 

OUrF(3,l) =0JT (7,1) 

CALL  MATM(CMA,OUTF,ACC,7,3,l) 
0(4) =ACC (1,1) 

P(5)=ACC(2,1) 

P(5) =AC: (7, 1)  4G 
no  35  1=7,15 
P(T) =U  (1^9) 

CONTINUE 
P(16)  = -S'=’(2,  1) 

P{17)=SF(3,1) 
o(ig)=SF (1,1) 

P(21)=-SF(3, 1) 

P(23)=-SF(i,i) 

P(24)=SF(2,1) 
P(18)=P(20)=P(22)=0. 
no  36  J=l,3 
no  36  1=1, •« 

P(21*lT3*J)=nM(I,  J) 

CONTINUE 
no  37  1=1,3 
P(33*I)=0M(I,1) 

CONTINUE 
RETURN 
FNO 

SUBROUTINE  SFNSOUT 
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xmn  ?A(1S  IS  BSST  (^OaMTT  Tmi(3TT.C4Mm 
JSOil  OOPX  JURHlSIiiS)  10001(2 
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THIS  PA8S  IS  BBSl  QUALl**  PBilCTIP*W 
COPY  yiflaasHH)  10 


♦SUBROUTINE  SENSOUT  CALCULATES  THE  OUTPUT  (RADAR  MEASUREMENTS  AND 
•SPFCTFTC  FORCES)  SENSITIVITIES  H.R.T.  THE  MISALIGNMENT  ANGLES. 

COMMON /TIMER7T,0T,TF,0PFT 
COMMON /NOMINAL / X, Y, 7, VX,VV,VZ,V 
C0MM0N/SENSTAT/SEPSP(3,3) ,SEPSV(3,3) 

C0MM0N/SENSRDR/SREPS(1,3) ,SR0EPS(1,3) , SPSREPS ( 1 , 3) , STEREPS( I , 3) 


SU*«R0UT1NF  SPNSOIIT 

♦5URR0UTINE  SENSOUT  CALCULATE?  THE  OUTPUT  (PAOAP  MEASUREMENTS  ANP 
♦SPECTPTC  FORCES)  SENSITIVITIES  W.R.T.  THE  MISALIGNMENT  ANGLES. 

4.0.t^4-9.**4’******-********9'******* 

COMMON /TIMER/T,OT,TF,OPFT 
C0MM0N/N0MINAL/X,Y,7, VX,VY,VZ, V 
COMMON/SENSTAT/SEPSP(3,3) ,SEPSV (3,3) 

COMMON/SENSROR/SREPS(1,3) ,SR0EPS(1,3) , SPSREPS ( 1 , 3) , 5TEREPS( I , 3) 

1 A COMMON/PLANX/CMA (3,3) ,GfMA{3,3) ,G AME ( 3, 3) , SF (3 , 1 ) ,GA3 ( 3 , 3 ) , 

I V iLIPT  (3,1)  ,0JT(7,1)  ,OUTN(L,4)  ,0UTRU(7,1)  ,FO,  ACC(3,l),S0UTEPS(i»,3) 
‘ DIMENSION  PR(1,3) ,VR(1,7)  ,XY(1,3) , XY Z (1 , 3) , TEMPI ( 1, 3)  ,TEMP2(1,3) 
P=3UT(1, 1) 

PR(1,1)=X/R 

PR(1,2)=Y/R 

PP(1,3)=Z/P 

PVR= (X*VX+Y*VY*7*v7) /(P*R) 

VP(l,l)=(VX/R-aVR*P»(l,l) ) 

V0(1 ,2)  = (VY/F’-PVR»PP(1,2)  ) 

VR(1,3)=(V7/P-PVR*PR(1,3) ) 

CALL  MATM (DP,SEPSP,SREPS,1,3,3) 

CALL  MATM(VP,SEPSF, TEMPI, 1,3,3) 

CALL  M ATM (PB,SEPSV,TEMP2, 1,3,3) 

DO  ID  1=1,3 

SP3EPS (1,1) =TEMP1 (1,1) ♦TEMP2(1,I) 

10  CONTINUE 

XY(l,l)=-X*Y/SOPT( (X*X+Y*Y)**3) 

XY(1,2)  = X*X/SQRT(  (X*X*Y*Y)**3) 

XY(1,3)=0. 

CALL  M AT M(XY,SE PSP, SPSREPS, 1,3, 3) 

*Y?(1,  1)  =-X*'7/R**3 

XYT(1,2) =-Y»7/P**3 

XYTd,  3)  = (X*X>Y*Y)  /R**3 

CALL  MATM{XY7,3EPSP,STEFEPS,1,3,3) 

PETURN 

ENO 

SUOPOUTINE  NOIZr  ( RmsnOIS , OUTMEAN , WM) 

♦SUPPOilTINE  NOI7E  CALCULATES  THE  VALUES  OF  THE  MEASUREMENT  NOISE 
♦COMPONENTS  USING  A RANDOM  NUMBER  GENERATOR  MODELLED  AS  GAJSSIAN. 

C0MM0N/N0ISVAP/RN,RDN,P‘‘IRN,TETRN,F1N,F2N,F3N 
COMMON/BLANK/CMA(3, 3) , GAM A (3, 3) , G AMF ( 3, 3 ) , SF ( 3 , 1 ) ,GAB(3,3), 

ALTPT (3,l),nUT(7,l) ,OUTN  (4  ,4) ,0UTRU(7, 1) , FD , ACC ( 3, 1) , SOUT EPS ( 4, 3 ) 
GA'JSS=C. 

00  10  1=1,12 
GAJSS=GAUSS<-RANF  (DUM) 

10  CONTINUE 

GAUSS= GAUSS-6. ♦OUT MEAN 

WN=GAUS5»RMSN0TS 

RETURN 

ENO 

SUOROUTINE  INFOMAT 

♦SUBROUTINE  INFOMAT  CALCULATES  THE  VALUES  OF  THE  INFORMATION 
♦matrix  and  gradient  VECTOR  DCREMENTS. 


common /T IMEO/T, OT,TF,OPPT 
COMMON /EPST»UE/PSTT,TETAT  ,PHIT 

rOMMON/3ENSROP/SREPS(l,3)  ,SR0EPS(1,3) , SPSREPS (1,3) , 5TEREPS( 1, 3) 
nOMMON/INFOMAT/M(3,3) ,H(3,1) , DM (3 , 3 ) , DM ( 3, 1 ) 

COMMON/9LANK/CMA (3,3) ,GAMA(3,3) ,GAMF(3,3) ,SF(3,1) ,GA3(3, 3), 

A LIFT  (3,1)  , OUT  (7  ,1 ) ,OUTN  (*♦  ,4)  ,0UTRU(7,1)  , FO  , ACC  ( 3, 1) , SOUT  EPS  ( 4 , 3 ) 
COMMON/LOGIC/MODEl 
PEAL  M 

LOGICAL  MOOEl 

DIMENSION  S0UFPST( 3,4) ,TEMPl(3,4)  ,00UT(4,1) 


ENT 

5IJTR0UTINE  INFOMAT 

♦SUBROUTINE  INFOMAT  CALCULATES  THE  VALUES  OF  THE  INFORMATION 
♦MATRIX  AND  GRADIENT  VECTOR  Ih'CREMENTS. 

^ )nm.9.m***if*************’******** 

COMMON/TIMER/T, OT,TF,OPRT 
COMMON /FPSTRUE/PSTT,  TET AT, PHIT 

rOMMON/3FNSROR/SRFPS(l,3)  ,SR0EPS( 1,3) .SPSREPS ( 1 , 3) , ST EREPS( 1 , 3) 
COMMON/INFOMAT/M{3,3) ,H(3,1) ,OM(3,3) ,0M(3,1) 

\\  COMMON /3LANK/CM A (3,3) , GAM A ( 3, 3 ) , G AMF ( 3, 3 ) , SF ( 3 , 1) ,GA3(3, 3), 

I ( A LIFT (3 ,1) , OUT (7 ,1) jOUTNin  ,4) ,0UTRU(7, 1) ,FO, ACC (3,1) , SOUTEPS (4, 3) 
COMMON/LOGIC/MOOEl 
REAL  M 

LOGICAL  MOOEl 

DIMENSION  S0UFPST( 3,4) ,TFMPl(3,4)  ,D0UT(4,1) 

DO  10  1*1,3 

SO'JTFPS(l,I)=SREPS(l,I) 

SOiJTE»S(2,I)=SRnEPS(l,I) 

SO’)TEOS(3,I)  = SPSREPS(1,I) 

S0'JTEPS(4,I)  =STFREPS(1,T) 

10  continue 

DO  20  1*1,4 
DO  20  J*l,3 

SOUEPSK  J,I)  =SOUTEPS(I  ,J) 

20  CONTINUE 

CALL  MATM(S0UFPST,0UTN,TEMP1,3,4,4)  2?*  M Bm  QUAMlTIRiiCIlfiiBTf 

CALL  MATM(TEM01,SOUTEPS,OM,3,4,3)  lODOfl 

DO  30  1=1,4  

DO'JT  (I,l)=OUTPU(T,  l)-OUT(I,l) 

3C  CONTINUE 

CALL  MATM(TEMP1,D0UT,0H,3,4,1) 

RETURN 

END 

SUBROUTINE  FULI NT (U,K, Of) 

DIMENSION  U(3S)  ,P(36) 

CALL  F(U,P) 

DO  10  J=1,K 
M(J)=U{J)*P(J)^OT 
10  CONTINUE 
RETURN 
ENO 

SUBROUTINE  M ATM ( A , B,C , M ,K , N) 
dimension  A(M,K),n(<,N),C(M,N) 
no  10  J=1,N 
no  10  1=1, M 

C(I,  J)  =0. 

DO  10  L=1,K 

10  C(T,J)=C(I,J)*A(T,L)*8(L,J) 

PETURN 

FNO 
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Transfer  Alignment 
Maxlmiun  Likelihood  v 

Parameter  Estimation 
'Information  Matrix 

^Tracking  and  Pointing 

20.  fConfInuo  on  rovoreo  aidoll  nocooomry  and  Identity  by  block  numbor) 

The  problem  of  parameter  estimation  using  tracking  information 
Is  examined.  Two  models  are  developed  and  used  to  estimate  the 
misalignment  angles  of  the  inertial  system  of  a missile  after  its 
launch.  The  estimation  is  based  on  maximum  likelihood  concepts. 
The  amount  of  information  extracted  from  the  tracking  measurements 
and  the  missile  specific  forces  measurements  is  analysed.  A 
feasibility  study  of  the  two  models  is  conducted.  The  second 
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enhance  its  estimation  ability.  Doing  this,  it  incorporates 
more  non-linearities  than  the  first  model.  These  severe  non- 
linearities  were  found  to  offset  the  advantage  it  had  in  terms 
of  information  gathering.  The  first  model  is  much  simpler  in 
its  concept.  Yet,  it  is  still  able  to  gather  the  information 
needed  and  its  performance  is  very  comparable  to  the  one  of  the 
second  model.  The  simplicity  and  linearity  of  the  first  model 
make  it  especially  attractive. 
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